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ABSTRACT 


The  Robotics  and  Automation  Center  for  Excellence  (RACE)  at  Kelly  Air  Force 
Base,  Texas,  has  defined  an  open  telerobotics  control  architecture.  This  architecture, 
called  the  Unified  Telerobotic  Architecture  Project  (UTAP),  is  a  proposed  standard  for  all 
Air  Force  telerobotic  systems.  Implementation  of  UTAP  will  reduce  the  cost  of  robotic 
applications  by  increasing  software  modularity,  portability,  and  reusability.  This  thesis 
continued  the  effort  to  prove  the  feasibility  of  UTAP. 

In  December,  1995, 1st  Lt  Anchor  implemented  a  portion  of  the  UTAP 
specification  on  a  PUMA  robot.  The  UTAP-compliant  controller  exhibited  some 
degradation  in  the  system  performance.  However,  the  performance  degradation  was  not 
fully  measured.  This  thesis  extended  the  measurements  of  Anchor’s  implementation. 

Additionally,  a  portion  of  the  UTAP  specification  was  implemented  on  an 
Adept  550  manipulator  and  the  performance  effects  were  measured.  The  implementation 
included  portions  of  the  generic,  robot/axis  servo  control,  tool  control,  sensor  control, 
programmable  10,  subsystem  task  level  control,  task  description  and  supervision,  parent 
task  program  sequencer,  task  program  sequencer,  and  object  knowledge  modules. 

Performance  measurements  of  the  Adept  implementation  indicated  that,  although 
performance  was  adversely  affected,  the  degradation  was  caused  by  the  interface  between 
the  UTAP-compliant  application  and  the  non-UTAP-compliant  operating  system.  There 
was  little  difference  between  the  complaint  and  non-compliant  applications. 

Successful  implementation  of  the  UTAP  specification  on  the  PUMA  and  Adept 
manipulators  proves  that  UTAP  is  a  feasible  telerobotic  architecture.  However,  further 
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study  of  the  specification  is  recommended.  Specifically,  the  development  of  a  UTAP- 
compliant  operating  system  should  be  continued. 


ANALYSIS  AND  DESIGN  OF  STANDARD  TELEROBOTIC 


CONTROL  SOFTWARE 

I.  Introduction 

The  Robot  Industries  Association  (RIA)  defines  a  robot  as  “a  reprogrammable, 
multifunctional  manipulator  designed  to  move  material,  parts,  tools  or  specialized  devices 
through  variable  programmed  motions  for  the  performance  of  a  variety  of  tasks”  [12].  A 
telerobotic  system  couples  the  robot’s  abilities  with  a  human  operator’s  abilities  to  think 
and  react.  There  are  three  basic  types  of  telerobotic  systems  based  on  the  amount  and 
type  of  interaction  between  the  robot  and  the  human.  The  first  type  of  telerobotic  system 
is  “operator  controlled.”  With  systems  of  this  type,  the  operator  has  complete,  real-time 
control  of  the  robot’s  movements.  The  second  type  is  “operator  supervised.”  In  this  case, 
the  robot  obeys  a  control  program  and  the  operator  does  not  have  direct,  real-time  control. 
However,  the  operator  can  stop  the  robot  or  change  the  program  as  required.  The  final 
type  is  “shared  control.”  This  is  a  combination  of  the  other  types.  The  operator  exerts 
some  real-time  control  over  the  robot  while  the  control  program  manages  the  remaining 
aspects  of  the  task  [12]. 

In  each  of  these  systems,  the  operator  provides  some  sort  of  input  to  the  system 
and  receives  some  type  of  output  or  feedback.  A  telerobotic  control  architecture  defines 
the  methodology  behind  providing  the  input  and  receiving  the  output.  Currently,  each 
telerobotic  system  has  its  own  control  architecture. 
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Because  each  system  has  its  own  unique  control  architecture,  it  is  very  difficult  to 
port  a  task,  or  function,  from  one  system  to  operate  on  another  system.  Therefore,  there 
is  very  little  reuse  of  software  in  the  telerobotic  field.  This  results  in  expensive  one-of-a- 
kind  installations.  To  lower  costs  and  improve  efficiency  and  productivity,  telerobotic 
systems  must  be  modular,  portable,  and  easily  reconfigurable.  A  standard  telerobotic 
control  architecture  would  provide  a  framework  for  developing  systems  that  meet  these 
objectives. 

Because  the  Air  Force  desires  the  use  of  telerobotic  systems  for  many  critical 
tasks  including  aircraft  painting  and  paint  stripping,  surface  cleaning,  and  sealing  and 
desealing  of  fuel  tanks,  the  Robotics  and  Automation  Center  for  Excellence  (RACE)  at 
Kelly  Air  Force  Base,  Texas,  has  defined  an  open  telerobotics  control  architecture.  This 
architecture,  called  the  Unified  Telerobotic  Architecture  Project  (UTAP),  is  a  proposed 
standard  for  all  Air  Force  telerobotic  systems.  UTAP  supports  a  modular  development 
that  ensures  plug-and-play  functionality.  The  standardized  interface  and  modularity  of 
UTAP  mean  that  a  telerobot  can  be  switched  from  one  task  to  another  simply  by 
switching  modules.  The  modularity  of  UTAP  also  increases  the  potential  reuse  of 
modules  on  new  tasks. 

LI.  Problem 

Before  I  conducted  my  research,  UTAP  had  only  been  implemented  on  one  Air 
Force  system.  This  was  accomplished  under  a  previous  AFIT  thesis  effort  conducted  by 
1st  Lt  Kevin  Anchor.  He  implemented  a  portion  of  UTAP  on  the  PUMA  robot  in  the 
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AFIT  Robotics  Laboratory  [3].  However,  the  effects  of  his  implementation  on  the 
performance  of  the  robot  were  not  completely  measured. 

In  addition  to  measuring  the  performance  of  Anchor’s  UTAP  implementation, 
other  systems  needed  to  be  retrofitted  to  the  UTAP  specification  before  UTAP  could  be 
considered  feasible.  Therefore,  I  implemented  the  UTAP  specification  on  the  Adept  550 
robot  in  the  robotics  laboratory  and  measured  the  performance  effects  of  the 
implementation. 

1.2.  Summary  of  Current  Knowledge 

Anchor’s  thesis  work  involved  implementing  the  UTAP  specification  on  the 
PUMA  560  manipulator  using  the  Chimera  3.2  real-time  operating  system.  Anchor 
measured  the  performance  effects  of  UTAP  by  commanding  the  robot  through  a  series  of 
motions  at  various  speeds  and  recording  the  difference  between  the  commanded  and  the 
actual  positions.  Measurements  were  taken  on  the  system  both  before  and  after 
implementing  UTAP.  He  then  plotted  the  amount  of  error  between  commanded  and 
actual  robot  position  and  performed  statistical  analysis  on  the  data  [3].  While  this  method 
gave  a  general  idea  of  the  performance  issues  associated  with  his  implementation,  several 
additional  steps  needed  to  be  completed  before  a  thorough  understanding  was  obtained. 
These  steps  included  controller  gain  tuning  and  modifying  the  trajectory  generation 
module  to  allow  step  response  testing.  They  are  defined  in  later  sections. 

In  addition  to  Anchor’s  work,  the  Advanced  Cybernetics  Group,  Inc.  (ACG) 
developed  some  applications  that  embodied  some  of  the  concepts  of  the  information 
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module  portion  of  the  UTAP  specification  [5].  ACG’s  code  provided  a  foimdation  for  the 
implementation  of  UTAP  on  the  Adept  550. 

1.3.  Scope 

This  research  effort  was  divided  into  two  separate  tasks;  performance  testing  of  Anchor’s 
UTAP  implementation  and  implementation  of  UTAP  on  the  Adept  robot.  The 
performance  testing  of  Anchor’s  UTAP  implementation  was  conducted  first.  I  only 
tested  the  UTAP  functionality  implemented  by  Anchor  and  did  not  implement  any  further 
UTAP  functionality  on  the  PUMA  manipulator.  Second,  portions  of  the  following 
modules  were  implemented  on  the  Adept  550  manipulator  using  the  V+  operating 
system: 


•  generic 

•  robot/axis  servo  control 

•  tool  control 

•  sensor  control 

•  programmable  10 

This  task  also  included  performance  testing. 


•  subsystem  task  level  control 

•  task  description  and  supervision 

•  parent  task  program  sequencer 

•  task  program  sequencer 

•  object  knowledge 


1.4.  Approach/Methodology 

As  stated  earlier,  my  research  consisted  of  two  major  tasks;  performance  testing 


of  Anchor’s  UTAP  implementation  and  implementation  of  UTAP  on  the  Adept  system. 


1.4.1  Performance  Testing  of  Anchor’s  UTAP  Implementation 

Performance  testing  was  conducted  using  the  following  general  steps: 


a.  Using  the  non-UTAP-compliant  controller,  command  the  robot  through  a 
series  of  motions  at  varying  speeds  while  recording  the  commanded  and  actual 
joint  position  values. 

b.  Tune  the  controller  gains  for  optimal  performance  of  Anchor’s  UTAP 
implementation. 
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c.  Using  Anchor’s  UTAP-compliant  controller,  command  the  robot  through  a 
series  of  motions  at  varying  speeds  while  recording  the  commanded  and  actual 
joint  position  values. 

d.  Modify  the  Chimera  trajectory  generation  module  to  allow  step  response 
testing 

e.  Using  Anchor’s  UTAP-compliant  architecture  and  the  modified  trajectory 
generation  module,  command  the  robot  to  perform  a  step  motion  while  recording 
the  commanded  and  actual  joint  position  values. 

f  Analyze  the  data. 

1.4.2  Implementation  of  UTAP  on  the  Adept  Manipulator 

Implementation  of  the  UTAP  specification  on  the  Adept  manipulator  was 
conducted  using  the  follow  steps: 

a.  Determine  an  appropriate  application  to  convert  to  UTAP  compliance. 

b.  Analyze  the  application  to  determine  which  program  statements  require 
modification. 

c.  Convert  the  program  statements  to  UTAP  messages. 

d.  Develop  an  interface  that  implements  the  UTAP  messages  in  the  V-i- 
programming  language. 

e.  Develop  a  test  routine  that  measures  the  running  time  of  the  application. 

f.  Measure  the  performance  of  the  non-UTAP  and  UTAP-compliant  versions  of 
the  application  by  executing  the  test  routine  with  the  robot  speed  set  to  25,  50,  75, 
and  100  percent  of  maximum. 

g.  Collect  metrics  on  source  lines  of  code  and  number  of  procedure  calls  for  both 
versions  of  the  application. 

h.  Analyze  the  data. 
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1.5.  Materials  and  Equipment 

All  necessary  equipment  and  software  were  available  in  the  AFIT  Robotics 

Laboratory.  The  software  and  equipment  required  to  test  Anchor’s  UTAP 

implementation  included  the  following: 

PUMA  560  manipulator 

VMEbus  hardware  associated  with  the  PUMA 

Sun  Sparc  2  workstation 

Chimera  3.2  real-time  operating  system 

SunOS  4.1.3  operating  system 

UTAP  software  developed  by  Anchor 

The  software  and  equipment  required  to  implement  the  UTAP  specification  on  the  Adept 

robot  included  the  following: 

Adept  550  manipulator  with  MV- 19  VME  controller 
VMEbus  hardware  associated  with  the  Adept 
V-H  1 1.1  operating  system  and  programming  environment 
ACG  UTAP  information  module  V+  code 

1.6.  Thesis  Organization 

This  thesis  report  is  divided  into  five  chapters.  Chapter  I  is  an  introduction  to  the 
topic  and  contains  background  information.  A  literature  review  of  current  robotic 
architecture  work  and  associated  information  is  presented  in  Chapter  II.  Chapter  III 
contains  the  methods  and  procedures  used  to  measure  the  performance  of  Anchor’s 
UTAP  implementation,  as  well  as  an  evaluation  of  the  research  results.  Chapter  IV 
describes  the  implementation  of  UTAP  on  the  Adept  system  and  presents  an  analysis  of 
the  results.  Finally,  Chapter  V  contains  the  conclusions  drawn  from  this  research  and 
makes  recommendations  for  the  UTAP  specification  and  future  research. 
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II.  Literature  Review 


In  this  literature  review,  I  present  an  initial  examination  of  the  current  work  in  the 
field  of  robotic  architectures.  I  have  limited  the  examinations  to  work  which  supports  the 
Air  Force’s  need  for  an  open  telerobotic  architectural  standard.  The  review  describes  the 
Unified  Telerobotic  Architecture  Project  (UTAP)  specification,  which  is  being  considered 
by  the  RACE  to  become  the  Air  Force  architecture  standard  for  robotic  systems.  This 
review  also  motivates  the  need  for  my  thesis  research,  which  is  to  investigate  the 
complexity  of  converting  a  telerobotic  system  to  be  compliant  with  the  UTAP 
specification  and  to  measure  the  performance  of  the  converted  system. 

The  review  begins  with  the  UTAP  specification.  The  specification  is  summarized 
and  its  purpose  and  goals  are  presented.  Then,  it  discusses  research  covered  by  a 
previous  AFIT  thesis  on  the  UTAP  specification  and  describes  the  remaining  research. 
This  is  followed  by  an  investigation  of  a  commercial  application  of  the  UTAP 
specification.  Finally,  the  review  presents  a  comparison  of  the  UTAP  effort  to  other 
standardization  efforts. 

II.l.  Unified  Telerobotic  Architecture  Project  Specification 

The  Unified  Telerobotic  Architecture  Project  is  described  in  [9].  The  UTAP 
specification  describes  a  standard  interface  environment  that  promotes  the  development 
of  modular,  portable,  and  reusable  robotic  applications.  To  help  avoid  point  solutions  to 
specific  applications,  the  UTAP  architecture  accommodates  different  types  of  robotic 
manipulators  with  different  degrees  of  freedom.  It  also  accommodates  different  part 
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materials  and  geometiys.  Additionally,  it  provides  a  facility  to  upgrade  or  change 
equipment,  sensors,  and  feedback  mechanisms  as  technology  advances. 

The  UTAP  architecture  is  composed  of  hardware  and  software  modules.  Each 
module  has  defined  inputs,  outputs,  and  responsibilities.  All  data  inside  a  module  is  self- 
contained  and  hidden  from  other  modules.  The  Object  Knowledge  module  stores  data 
that  is  needed  by  multiple  modules.  Data  and  control  flow  are  passed  between  modules 
through  the  use  of  pre-defmed  messages.  Thus,  the  UTAP  specification  defines  the 
modules  and  interfaces  that  make  up  the  system. 
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Figure  11. 1  shows  the  overall  UTAP  architectural  block  diagram.  Each  box 
represents  a  module  and  each  line  represents  a  communication  channel.  Arrows  on  the 
line  show  which  direction  communication  can  occur.  Communication  can  only  occur 
between  coimected  modules. 

For  any  particular  application,  not  all  of  the  modules  need  to  exist.  Likewise, 
some  modules  may  have  multiple  instances.  The  local  and  remote  controllers  each  have  a 
configuration  file  that  specifies  which  modules  compose  the  system.  For  example,  if  the 
Object  Modeling  module  is  not  needed,  then  the  corresponding  configuration  file  would 
indicate  the  absence  of  that  module  from  the  system.  Furthermore,  not  all  modules  will 
accommodate  every  interface  message.  Therefore,  each  module  maintains  a  service 
profile  that  describes  the  set  of  UTAP  messages  and  data  posting  capabilities  supported 
by  the  module. 

The  UTAP  specification  provides  a  foundation  for  a  standard  telerobotic 
architecture.  However,  there  are  some  minor  naming  inconsistencies  in  the  specification. 
For  example,  the  UTAP  specification  gives  three  different  names  for  the  SGD  module; 
“Status  Graphics  and  Displays”,  “Status  and  Graphical  Display”,  and  “Status  Graphics 
Displays.”  It  is  even  abbreviated  as  SDG  in  some  places.  The  different  names  can  imply 
different  functions  for  the  module.  Inconsistencies  of  this  nature  also  appear  in  other 
areas  of  the  specification.  For  example,  twenty  different  modules  are  named  throughout 
the  document.  However,  messages  are  only  defined  for  seventeen  modules. 

Additionally,  some  areas  of  the  specification  require  more  explanation  or  clarification. 
The  UTAP  messages  are  an  example  of  this.  The  meaning  and  purpose  behind  each 
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message  should  be  described.  Without  defining  the  meaning  of  each  message,  an 
individual  implementing  a  UTAP-compliant  application  may  not  know  which  message  to 
use  to  accomplish  a  particular  task.  Chapter  VI  further  addresses  these  issues  with  the 
UTAP  specification  and  presents  my  recommendations. 

II.2.  Previous  AFIT  Research 

Anchor’s  research  [3]  represents  the  first  implementation  of  UTAP.  His  research 
primarily  involved  redesigning  the  AFIT  Robotics  and  Automation  Applications  Group 
(RAAG)  Lab  B  PUMA  manipulator  to  be  compliant  with  the  UTAP  architecture. 
Anchor’s  thesis  shows  the  UTAP  specification  to  be  implementable.  However,  if  the 
underlying  operating  system  does  not  support  generic  message  passing,  an  interface  layer 
must  be  implemented  to  access  operating  system  functions. 

Anchor’s  UTAP-compliant  controller  implemented  portions  of  the  robot  servo 
control,  object  knowledge,  and  operator  interface  modules  of  the  specification  (see  Figure 
II.  1).  The  controller  performed  adequately;  although,  there  was  degradation  in  the 
performance  as  evidenced  by  increased  position  error  during  trajectories.  Additionally, 
Anchor  pointed  out  the  “spikiness”  of  the  error  plots  of  the  UTAP  controller  when 
compared  to  the  plots  of  the  non-UTAP  controller  (see  Figure  III.3).  He  indicated  that 
the  “spikiness”  was  due  to  the  lack  of  controller  gain  tuning.  This  is  further  addressed  in 
the  next  chapters. 

Anchor  conducted  his  performance  measurements  without  tuning  the  gains  of  his 
UTAP-compliant  controller.  Gain  tuning  will  optimize  the  performance  of  the  controller 
and  decrease  the  amount  of  error.  Furthermore,  Anchor  obtained  his  measurements  by 
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using  the  Chimera  trajectory  generation  module  to  move  the  robot  in  a  step  response  and 
the  Chimera  track  module  to  record  the  commanded  and  actual  joint  angles.  The 
trajectory  generation  module  computes  the  trajectory  needed  to  move  the  robot  from  the 
current  position  to  the  commanded  position.  It  accomplishes  this  by  dividing  the 
difference  between  the  positions  into  very  small  increments  and  moving  the  robot 
through  each  increment.  Error  compensation  takes  place  at  each  increment.  Thus,  the 
trajectory  generation  module  does  not  provide  a  true  step  response  motion. 

The  motion  command  of  the  trajectory  generation  module  hides  some  of  the 
performance  degradation  of  the  UTAP-compliant  controller.  To  avoid  this,  the  trajectory 
generation  module  must  be  modified  to  command  the  robot  directly  from  the  initial 
position  to  the  final  position  without  the  incremental  movement.  This  is  a  true  step 
response  and  provides  more  accurate  data  on  the  performance  of  the  UTAP-compliant 
controller. 

II.3.  Commercial  Work  Associated  with  UTAP 

Using  the  UTAP  specification  as  a  guide.  Advanced  Cybernetics  Group,  Inc. 
(ACG)  has  implemented  several  robotic  application  building  blocks  that  are  compatible 
with  the  UTAP  philosophy  [5],  ACG  built  their  product  on  the  commercially  available 
Adept  V+  robotic  programming  language.  In  addition  to  describing  the  application’s 
implementation,  ACG  gives  examples  of  commercial  and  Air  Force  sites  that  are  using 
their  product  to  perform  tasks  with  telerobotic  systems. 

ACG  begins  to  show  that  the  philosophy  of  the  UTAP  document  is  sound  and 
commercially  available  products  can  be  used  to  implement  the  UTAP  specification. 
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ACG’s  design  of  their  building  blocks  conforms  to  the  UTAP  goals  of  modularity  and 
reusability.  They  have  also  adopted  a  module  naming  convention  similar  to  the  UTAP 
message  naming  convention.  However,  the  ACG  work  focuses  on  the  sensor  control 
portion  of  the  UTAP  specification.  The  remaining  portions  of  UTAP,  such  as  task  level 
control,  programmable  10,  etc.,  are  not  implemented. 

ACG  has  shown  that  a  commercially-available  product  can  be  used  to  implement 
modules  that  are  generic  enough  to  be  used  in  several  different  robotic  applications.  This 
confirmed  that  modularity  and  reusability  are  obtainable  goals.  However,  ACG  did  not 
closely  match  their  naming  conventions  and  message  parameters  with  the  UTAP 
specification.  This,  coupled  with  the  fact  that  ACG  focused  primarily  on  the  sensor 
control  module  while  I  intended  to  implement  a  broader  portion  of  the  UTAP 
specification,  prevented  me  from  simply  building  upon  their  V+  code  as  I  had  originally 
intended. 

II.4.  Other  Standardization  Efforts 

To  understand  the  amount  of  time  and  effort  required  to  develop  a  standard  with 
the  amount  of  complexity  inherent  in  a  telerobotic  architecture,  we  can  compare  the 
UTAP  effort  to  the  effort  expended  developing  the  Ada  programming  language.  The 
benefits  of  a  standardized  architecture  can  be  seen  by  looking  at  the  benefits  obtained 
through  the  Portable  Operating  System  Interface  (POSIX)  standard. 

II.4.1.  Ada 

In  1974,  the  Department  of  Defense  (DoD)  initiated  the  common  high  order 
language  program  to  define  the  requirements  for  a  common  language  for  programming 
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large  scale  and  real-time  systems  [6].  After  extensive  reviews  by  the  Services,  industrial 
organizations,  universities,  and  foreign  military  departments,  the  final  requirements  were 
published  in  the  Steelman  specification.  This  phase  in  the  development  of  Ada  lasted  for 
four  years. 

Implementation  of  the  requirements  began  in  1978  and  culminated  in  1983  with 
the  publication  of  ANSI/MIL-STD-1815A.  This  five-year  development  consisted  of 
three  phases.  The  design  team  received  numerous  evaluation  reports  at  the  end  of  the 
first  and  second  phases.  During  the  third  phase,  they  received  nine  hundred  language 
issue  reports  and  test  and  evaluation  reports  from  fifteen  different  countries.  The  design 
team  also  conducted  several  intense  week-long  design  reviews  attended  by  dozens  of 
industry  experts. 

From  the  above  paragraphs  we  see  that  the  Ada  project  took  nine  years  and 
thousands  of  man-hours  to  reach  the  first  release.  In  contrast,  UTAP  began  in  1992  as  an 
engineering  study  of  Air  Logistic  Center  (ALC)  remanufacturing  processes  conducted  by 
NASA's  Jet  Propulsion  Laboratory  (JPL)  [1 1]  and  the  UTAP  working  group  consisted  of 
ten  individuals.  Certainly,  UTAP  does  not  have  the  same  publicity  that  Ada  has;  and  it 
definitely  does  not  have  the  same  support  and  funding  as  Ada.  Therefore,  we  cannot 
expect  to  apply  the  same  amount  of  effort  to  UTAP.  On  the  other  hand,  the  comparison 
shows  that  exceptional  progress  has  already  been  made  on  the  UTAP  specification 
considering  the  level  of  effort  expended.  Likewise,  the  comparison  shows  that  it  is 
reasonable  to  expect  that  a  considerable  amount  of  work  remains. 
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II.4.2.  Portable  Operating  System  Interface  (POSIX) 

The  POSIX  System  Interface  Standard  is  the  central  open  system  standard  related 
to  the  historical  UNIX  timesharing  system  and  is  an  application  program  interface 
standard  for  basic  operating  system  functions  [10].  The  POSIX  working  group  had  the 
following  four  main  goals  when  developing  the  standard: 

1 .  Promote  application  source  code  portability 

2.  Specify  an  interface,  rather  than  an  implementation 

3 .  Consider  all  maj  or  historical  implementations 

4.  Keep  the  interface  minimal 

By  achieving  these  goals,  the  working  group  has  ensured  that  applications  developed  for 
POSIX-compliant  systems  can  be  ported  to  new  POSIX-compliant  systems  with  minimal 
effort.  This  saves  time  and  money  by  providing  users  with  the  capability  to  upgrade  and 
expand  their  systems.  By  specifying  the  interface  but  not  the  implementation,  the 
working  group  ensured  that  users  can  take  advantage  of  new  technology.  In  other  words, 
as  long  as  the  interface  remains  the  same,  an  old  implementation  can  be  replaced  by  a 
better  one. 

When  examining  the  goals  of  the  UTAP  specification,  we  find  a  direct 
correspondence  to  the  goals  of  the  POSIX  working  group.  It  is  reasonable  to  expect 
UTAP  will  benefit  from  the  same  advantages  as  those  experienced  by  POSIX  compliant 
systems,  provided  the  UTAP  goals  are  obtained. 

II.5.  Summary 

A  standard  interface  environment  for  telerobotic  applications  will  reduce  the  cost 
of  telerobotic  systems  by  increasing  module  reuse  and  portability  and  by  decreasing 
module  development  time  and  costs.  The  UTAP  specification  defines  a  standard  that 
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attempts  to  meet  these  goals.  Anchor’s  research  showed  the  feasibility  of  implementing 
the  UTAP  specification  on  one  particular  platform.  However,  there  are  still  performance 
issues  to  be  investigated  and  UTAP  must  be  implemented  and  tested  on  additional 
platforms.  ACG’s  work  proves  that  robotic  applications  can  be  developed  by  re-using 
generic  modules  written  in  the  V+  language.  Finally,  by  comparing  the  UTAP  effort  to 
other  standardization  efforts,  we  see  that  the  process  of  developing  and  implementing  a 
large  standard  of  this  nature  is  difficult  and  time  consuming  but  the  rewards  are  worth  the 
effort. 
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III.  Performance  Measurement  of  Anchor’s  UTAP  Implementation 

This  chapter  describes  the  methodology  behind  the  performance  measurement  of 
Anchor’s  UTAP  implementation.  It  presents  the  steps  followed  to  accomplish  the 
measurement  and  justifies  the  choices  made  while  conducting  the  measurement.  It  then 
provides  an  analysis  of  the  data  obtained  the  from  the  measurements. 

111.1.  Methodology 

This  section  is  divided  into  three  parts.  The  first  part  contains  preliminary 
information  about  Chimera  and  Anchor’s  UTAP  controller  that  is  needed  to  imderstand 
the  methods.  The  second  part  contains  the  steps  taken  to  prepare  for  the  performance 
measurement.  Finally,  the  third  part  explains  the  actual  performance  measurement. 

111.1. 1.  Preliminary  Information 

Anchor  implemented  his  UTAP-compliant  controller  under  the  Chimera  Real- 
Time  Operating  System  (OS).  Chimera  provides  the  interface  between  the  operator  and 
the  manipulator  hardware.  It  converts  the  program  commands  (movement  commands 
etc.)  to  digital  signals  and  sends  them  to  the  manipulator  hardware.  Chimera  supports 
application  development  in  the  C  and  C++  programming  languages.  It  is  the  Chimera  OS 
that  provides  the  functions  to  use  and  program  the  manipulator. 

Throughout  his  research,  Anchor  used  several  predefined  manipulator  positions. 
To  maintain  continuity  with  his  performance  tests,  I  used  the  same  positions.  Table  III.l 
lists  the  relevant  positions.  The  values  are  in  radians  and  are  measured  from  the 
baseframe  of  the  respective  joint. 
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In  many  of  the  steps  deseribed  below,  the  term  “spawned”  is  used.  Under 
Chimera,  spawning  a  module  loads  the  module  into  memory,  but  does  not  begin 
execution  of  the  module.  The  “on”  command  begins  the  execution  of  the  module,  or 
activates  it.  It  is  through  the  “on”  command  that  operator-input  parameters,  if  required, 
are  passed  to  the  module. 


Position  Name 

Joint  1 

Joint  2 

Joint  3 

Joint  4 

Joint  5 

Joint  6 

Home 

0.0 

-1.5708 

1.5708 

0.0 

0.0 

0.0 

Data  Initial 

0.0 

-2.36 

2.36 

0.0 

0.0 

0.0 

Data  Final 

1.5708 

-1.5708 

0.524 

0.0 

0.0 

0.0 

Table  III.1.  Predeflned  Positions  (radians) 


Several  Chimera  modules  are  also  mentioned  in  this  chapter.  What  follows  is  a 
brief  description  of  their  purpose  and  the  results  of  their  execution. 

The  Chimera  puma_pidg  module  is  the  proportional  integral  derivative  (PID) 
controller  module  used  on  the  AFIT  PUMA  560  manipulator  under  the  Chimera 
operating  system.  Anchor  modeled  his  UTAP-compliant  controller  after  the  puma_pidg 
module  and  the  Chimera  gravity  compensation  (grav_comp)  module. 

The  Chimera  trjjgen  module  is  the  trajectory  generator  and  accepts  as  input  the 
desired  joint  angles  (measured  in  radians  from  the  baseffame  of  each  joint)  and  a 
movement  duration  (measured  in  seconds).  From  these  values,  the  module  computes  a 
trajectory  (as  described  in  section  II.2.)  that  will  move  the  manipulator  to  the  desired  joint 
angles. 

The  Chimera  track  module  records  the  manipulator’s  commanded  and  actual  joint 
angles  during  movement.  When  the  track  module  is  activated,  it  records  the  data  at  a  rate 
of  fifty  samples  per  second.  The  data  is  written  to  a  file  specified  at  activation. 
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Anchor’s  int_RSC  module  was  the  interface  module  between  his  UTAP- 
compliant  controller  (the  UTAP_RSC  module)  and  the  Chimera  operating  system 
functions.  Figure  III.l  shows  the  relationship  between  Anchor’s  interface  and  UTAP 
modules  and  the  Chimera  OS  modules.  In  Anchor’s  modules,  RSC  stands  for  Robot 
Servo  Control. 


Figure  IILl.  Anchor’s  UTAP  Implementation  (adapted  from  [8]) 

To  start  the  UTAP-compliant  controller,  the  user  spawns  and  activates  the  int_RSC 
module.  The  int_RSC  module  accesses  the  UTAP_RSC  functions  that  include  the  PID 
controller  and  gravity  compensation  functionality. 

III.1.2.  Preparatory  Steps 

Before  I  could  begin  the  performance  measurements,  I  needed  to  tune  the  gains  of 
Anchor’s  controller  and  establish  a  performance  baseline.  These  steps  are  described  and 
justified  in  the  next  two  sections. 
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IILl.2.1.  Gain  Tuning 

To  accurately  measure  the  performance  limits  of  a  system,  the  system  must  be 
operating  at  its  optimal  level.  In  section  IV.3  of  [3],  Anchor  suggested  that  the 
performance  of  his  UTAP-eompliant  system  could  be  improved  by  controller  gain  tuning. 
Therefore,  his  system  required  gain  tuning  before  the  performance  eould  be  measured. 

In  [7],  Klafter  deseribes  the  basie  steps  required  to  gain  time  a  PID  eontroller  as 
follows: 

1 .  With  K;  ==  Kd  =  0,  adjust  Kp  until  the  system  step  response  is  either  critieally 
(or  slightly  under-)  damped. 

2.  For  the  value  of  Kp  just  found,  increase  Kj  until  the  steady-state  error  is 
either  zero  or  has  reaehed  an  "acceptable"  value.  (Normally,  Kj  >  Kp.) 

3.  Increase  K^  until  the  system  step  response  is  again  either  critically  or 
slightly  underdamped. 

Each  joint  of  the  manipulator  has  its  own  values  for  Kp,  Kj,  and  Kj  and  must  be  tuned 
separately.  Under  Anchor’s  UTAP  implementation,  all  three  values  for  each  of  the  six 
joints  are  stored  in  the  eonfiguration  file  named  int_rsc.rmod. 

IILI.2.1.1.  Joint  One  Gain  Tuning 

Joint  one  was  gain  tuned  using  Klafter’ s  procedure  without  deviation.  I 
determined  when  the  joint  was  critically  damped,  slightly  under-damped,  or  had  an 
acceptable  steady-state  error  by  plotting  the  joint  position  data  at  each  iteration  of  the 
proeedure.  The  Chimera  track  module  was  used  to  record  the  data  while  the  joint  moved 
through  a  90.0  degree  are. 

III.1.2.1.2.  Results  from  Gain  Tuning  Joint  One 

During  the  tuning  of  joint  one,  I  quickly  learned  that  it  was  going  to  be  a  very 
time  consuming  process.  Eaeh  adjustment  of  one  of  the  values  meant  that  each  module 
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must  be  unloaded,  the  value  changed,  the  modules  re-spawned,  the  movement  started,  the 
data  extracted  from  the  trjjgen  output,  the  data  plotted,  and  the  next  change  determined. 
Occasionally,  the  system  would  give  an  error  message  stating  that  it  was  not  calibrated. 
When  this  occurred,  I  had  to  kill  all  the  active  modules,  calibrate  the  manipulator,  and  re¬ 
load  all  the  modules.  Since  this  was  a  time  consuming  process,  I  decided  to  combine 
steps  and  save  time. 

111.1.2.1.3.  Joint  Two  Gain  Tuning 

For  joint  two,  I  began  at  the  home  position  with  the  original  gains.  A  -90.0  degree 
movement  was  commanded  and  the  position  data  from  the  track  module  was  plotted. 
Then,  based  on  the  results  from  joint  one,  the  movement  was  commanded  with  an 
increased  Kp  and  again  with  a  decreased  Kp,  leaving  K;  and  Kj  at  the  original  values.  By 
analyzing  the  resulting  plots  of  these  three  movements,  it  could  be  determined  that  joint 
two  was  already  critically  damped  with  the  original  Kp  value. 

Next,  the  Kj  value  was  slightly  increased  and  the  Kj  value  was  slightly  decreased 
from  the  original  values.  This  decision  was  also  based  on  the  results  of  tuning  joint  one. 
After  commanding  the  -90.0  degree  movement,  the  results  were  analyzed.  The  trajectory 
was  slightly  improved.  I  continued  this  process  until  I  was  satisfied  with  the  joint  two 
trajectory.  The  modified  procedure  saved  two  days. 

111.1.2.1.4.  Joint  Three  Through  Six  Gain  Tuning 

The  joint  two  procedure  was  used  on  joints  three  through  six  with  similar  time 
savings.  Table  III.2  shows  the  gain  values  before  and  after  tuning.  Appendix  D  contains 
the  trajectory  plots  for  all  six  joints. 
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Joint 

Kp 

Ki 

1 

Before 

After 

Before 

After 

Before 

After 

1 

4000 

4000 

5 

20 

80 

20 

2 

11000 

11000 

5 

20 

114 

10 

3 

3000 

3000 

5 

20 

25 

25 

4 

500 

500 

5 

5 

7 

7 

5 

310 

310 

5 

5 

7 

7 

6 

300 

300 

5 

5 

17 

17 

Table  III.2.  Gain  Values 


III.1.2.2.  Obtaining  a  Baseline 

Besides  tuning  the  controller  gains,  another  step  was  required.  Before  the 
performance  of  Anchor’s  UTAP  implementation  could  be  measured,  a  performance 
baseline  of  the  original  system  had  to  be  obtained.  With  this  baseline,  a  comparison 
could  be  made  between  the  original  system  and  Anchor’s  UTAP-compliant  system.  For 
the  comparison  to  be  valid,  the  baseline  had  to  be  obtained  by  executing  the  Chimera 
functions  that  matched  the  functions  implemented  in  the  UTAP  controller.  Anchor 
modeled  his  UTAP  system  after  the  Chimera  pumajpidg  and  grav_comp  modules. 
Therefore,  the  baseline  was  obtained  using  those  Chimera  modules. 

The  steps  used  to  obtain  the  baseline  were  the  same  steps  Anchor  used  to  obtain 
his  performance  measurements.  Additionally,  data  was  collected  from  the  same  three 
movement  durations  used  by  Anchor.  The  fast  movement  lasted  1 .5  seconds,  the  nominal 
movement  lasted  3  seconds,  and  the  slow  movement  lasted  5  seconds.  The  measurements 
were  taken  during  the  movement  of  the  manipulator  from  the  data  initial  position  to  the 
data  final  position.  These  positions  were  the  same  as  those  used  by  Anchor  and  are 
shown  in  Table  III.l .  For  each  of  the  three  motion  durations,  I  activated  the  puma_pidg. 
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grav_comp,  and  trjjgen  modules,  giving  the  trjjgen  module  the  data  initial  position. 
When  the  manipulator  reached  the  data  initial  position,  the  track  module  was  activated. 
Then,  the  trjjgen  module  was  activated  with  the  data  final  position  and  the  appropriate 
duration.  Upon  completion  of  the  movement,  the  data  file  created  by  the  trjjgen  module 
contained  the  commanded  and  actual  joint  position  value  samples.  Since  this  was 
accomplished  for  each  of  the  motion  durations,  three  files  were  produced  containing  data. 
With  this  data,  the  error  between  commanded  and  actual  joint  positions  could  be 
calculated.  This  error  data  constituted  the  baseline  performance. 

III.1.3.  Measurement  of  the  Performance 

This  section  of  the  chapter  is  divided  into  three  parts.  This  first  part  discusses  the 
pseudo-step  response  performance  measurements.  These  are  the  same  type  of 
measurements  as  conducted  by  Anchor.  The  second  part  describes  my  attempt  at  a 
modified  step  response  performance  measurement.  The  step  response  issue  was  first 
addressed  in  section  II.2  and  is  further  addressed  below.  The  final  part  discusses  missed 
cycle  testing. 

III.1.3.1.  Pseudo-Step  Response 

As  discussed  in  section  II.2,  the  trjjgen  module  does  not  provide  a  true  step 
response  motion.  However,  the  measurements  taken  by  Anchor  did  give  a  good  general 
idea  of  the  performance  of  his  UTAP  controller.  Also,  I  wanted  to  see  how  much  the 
gain  tuning  affected  the  performance.  Therefore,  I  conducted  the  performance 
measurement  of  the  gain  tuned  system  using  Anchor’s  method  (which  is  also  the  same 
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method  used  to  obtain  the  baseline).  Section  III.2.2  contains  an  analysis  of  the  data 
received  during  these  measurements  and  Appendix  E  contains  the  position  error  plots. 

111.1.3.2.  Modified  Step  Response 

The  first  task  imder  this  portion  of  the  research  was  to  modify  the  Chimera 
trjjgen  module  to  perform  a  true  step  response  motion.  The  modification  involved 
removing  the  loop  in  the  trjjgenCycle  function  that  divided  the  difference  between  the 
current  position  and  the  desired  position  into  small  increments  and  moved  the  joint 
through  the  increments.  Instead,  the  function  now  moves  the  joint  directly  from  the 
current  position  to  the  desired  position.  Appendix  F  contains  the  trjjgenCycle  function 
source  code  both  before  and  after  modification. 

The  next  task  involved  using  the  modified  trjjgen  module  to  collect  the  step 
response  data.  I  attempted  to  follow  the  same  data  collecting  procedure  as  I  had  used 
with  the  pseudo-step  response  function.  However,  any  attempt  to  command  movement 
resulted  in  severe  oscillations  of  joint  four,  five,  or  six.  Once  the  oscillations  started,  the 
emergency  kill  switch  had  to  be  pressed  to  stop  them.  Therefore,  use  of  the  modified  step 
response  for  performance  testing  was  not  feasible.  Section  III.2.3  discusses  these 
oscillations  and  their  probable  cause. 

111.1.3.3.  Missed  Cycle  Testing 

I  had  originally  planned  to  conduct  a  third  performance  test  on  Anchor’s 
controller.  Under  this  test,  the  execution  frequency  of  the  original  controller  would  have 
been  slowed  to  the  point  were  it  almost  missed  cycles  but  did  not.  I  would  have  then 
attempted  to  execute  the  UTAP  controller  at  the  same  frequency.  If  execution  was 
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possible  and  the  controller  was  stable,  the  number  of  missed  cycles  would  have  been 
counted  and  evaluated.  However,  contrary  to  Anchor’s  belief,  the  UTAP  controller  was 
already  missing  cycles  at  the  current  operating  frequency.  The  missed  cycles,  coupled 
with  the  oscillations,  prevented  the  conduction  of  this  test. 

III.2.  Analysis 

This  section  is  divided  into  three  parts  corresponding  to  the  gain  tuning,  pseudo¬ 
step  response  testing,  and  step  response  testing  of  Anchor’s  controller.  In  each  part,  the 
data  is  presented  and  explained. 

III.2.1.  Gain  Tuning 

Figure  III.2  shows  the  final  trajectory  plot  obtained  while  tuning  joint  one.  The 
graph  shows  the  joint  one  trajectories  for  before  and  after  gain  tuning.  As  can  be  seen, 
there  is  a  significant  improvement  in  the  post-gain  tuned  trajectory  over  the  pre-gain 
tuned  trajectory.  The  post-gain  tuning  trajectory  reaches  steady  state  much  sooner  and 
has  less  over-shoot. 


Joint  1  Position  Plot 


Figure  111.2.  Trajectory  Plot  for  Joint  One 
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Joints  two  and  three  showed  similar  improvements.  As  shown  in  Table  III. 2,  the 
gains  for  joints  four,  five,  and  six  did  not  require  changing.  Therefore,  the  position  plots 
show  only  a  single  trajectory.  Appendix  D  contains  the  trajectory  plots  for  all  six  joints. 

ni.2.2.  Pseudo-Step  Response 

From  the  data  obtained  by  the  baseline  measurements,  I  calculated  the  error 
between  the  commanded  and  actual  positions  of  each  joint  for  each  trajectory'  on  the  non- 
UTAP  controller.  The  data  obtained  during  the  pseudo-step  response  measurement  was 
then  used  to  calculate  the  position  error  of  each  joint  for  each  trajectory  on  the  gain-timed 
UTAP  controller.  These  error  values,  along  with  the  values  obtain  by  Anchor  for  the 
non-gain  tuned  UTAP  controller,  were  then  plotted.  Each  plot  shows  the  original,  non¬ 
gain  tuned  UTAP,  and  gain  tuned  UTAP  controller’s  error  for  a  particular  joint  at  one  of 
the  three  trajectory  durations.  The  error  plot  for  the  nominal  trajectory  of  joint  one  is 
shown  in  Figure  III.  3  and  Appendix  E  contains  all  the  error  plots. 


Figure  III.3.  Joint  1  Error  for  Nominal  Trajectory 
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The  error  values  are  in  radians  and  are  plotted  against  the  cycle  of  the  periodic  task  that 
recorded  the  data.  The  cycle  can  be  equated  to  time  since  the  task  recorded  the  data  once 
each  cycle  and  it  was  executed  at  a  frequency  of  50  Hz. 

Tables  III. 3,  III.4,  and  III. 5  show  the  integral  error  exhibited  by  each  controller.  I 
calculated  these  values  by  summing  the  absolute  value  of  the  error  measurement  at  each 
cycle.  The  percent  difference  between  the  original  controller  and  the  pre-gain  tuned 
controller  was  calculated  using  the  following  equation: 

PercentDijference  =  100  x 

The  percent  difference  between  the  original  controller  and  the  post-gain  tuned  controller 
was  calculated  using  the  following  equation: 


PreGainTunedError  -  OriginalError 
PreGainTunedError 


PevcemDigerence  =  100  x  (  f -  OrigmalEn-oA 

V  PostGainTunedError  ) 

Likewise,  the  percent  difference  between  the  pre-gain  tuned  controller  and  the  post-gain 
tuned  controller  was  calculated  with  this  equation: 


PercentDijference  =  100  x 


PostGainTunedError  -  PreGainTunedError 
PostGainTunedError 


Joint  1 

Joint  2 

Joint  3 

Joint  4 

Joint  5 

Joint  6 

Total 

Original  Error: 

1.9273 

0.8392 

1.1085 

0 

0 

0 

3.8751 

Pre-gain  Tuning  Error: 

1.7497 

0.9547 

0.8569 

0.5317 

0.1558 

95.228 

99.4768 

Post-gain  Tuning  Error: 

0.1347 

0.1208 

0.1442 

0.1124 

0.0658 

0.2828 

0.8607 

Original  vs  Pre-gain  Tuning 
Percent  Difference 

-10.15 

12.09 

-29.37 

100.00 

100.00 

100.00 

96.10 

Original  vs  Post-gain 

Tuning  Percent  Difference 

-1,330.35 

-594.80 

-668.84 

100.00 

100.00 

100.00 

-350.22 

Pre-gain  Tuning  vs  Post- 

-1,198.53 

-690.38 

-494.31 

-373.16 

-136.86 

-33,566.96 

-11,457.39 

gain  Tuning  Percent 
Difference 


Table  IIL3.  Integral  Error  for  Slow  Trajectory 


Joint  1 

Joint  2 

Joint  3 

Joint  4 

Joint  5 

Joint  6 

Total 

Original  Error: 

2.3087 

0.9821 

1.2041 

0 

0 

0 

4.4948 

Pre-gain  Tuning  Error: 

2.2042 

1.1034 

1.0679 

0.8692 

0.2423 

104.7391 

110.2261 

Post-gain  Tuning  Error: 

0.2007 

0.1221 

0.2247 

0.1673 

0.1010 

0.4785 

1.2943 

Original  vs  Pre-gain  Tuning 
Percent  Difference 

-4.74 

11.00 

-12.75 

100.00 

100.00 

100.00 

95.92 

Original  vs  Post-gain 

T uning  Percent  Difference 

-1,050.42 

-704.57 

-435.78 

100.00 

100.00 

100.00 

-247.26 

Pre-gain  Tuning  vs  Post¬ 
gain  Tuning  Percent 
Difference 

-998.35 

-803.99 

-375.19 

-419.45 

-139.91 

-21,786.81 

-8,415.96 

Table  III.4.  Integral  Error  for  Nominal  Trajectory 


Joint  1 

Joint  2 

Joint  3 

Joint  4 

Joint  5 

Joint  6 

Total 

Original  Error: 

2.9561 

1.1813 

1.5658 

0 

0 

0 

5.7032 

Pre-gain  Tuning  Error: 

2.8886 

1.3002 

1.5148 

1.6659 

0.4419 

1.3951 

9.2065 

Post-gain  Tuning  Error: 

0.2666 

0.1379 

0.3385 

0.3019 

0.1756 

0.9034 

2.1239 

Original  vs  Pre-gain  Tuning 
Percent  Difference 

-2.34 

9.15 

-3.37 

100.00 

100.00 

100.00 

38.05 

Original  vs  Post-gain 

T uning  Percent  Difference 

-1,008.98 

-756.42 

-362.54 

100.00 

100.00 

100.00 

-168.53 

Pre-gain  Tuning  vs  Post¬ 
gain  Tuning  Percent 
Difference 

-983.66 

-842.65 

-347.47 

-451.81 

-151.68 

-54.43 

-333.48 

Table  III.5.  Integral  Error  for  Fast  Trajectory 


The  plots  and  the  tables  show  that,  in  all  cases,  by  gain  tuning  the  UTAP 
controller,  the  error  was  reduced  from  that  exhibited  by  the  non-gain  tuned  UTAP 
controller.  In  fact,  the  error  values  for  all  trajectories  of  joints  one,  two,  and  three  of  the 
post-gain  tuned  controller  are  less  than  the  values  for  the  original  controller. 

Additionally,  the  total  error  values  for  all  trajectories  of  the  post-gain  tuned  controller  are 
less  than  the  values  for  the  original  controller.  If  only  the  total  error  and  percent 
difference  numbers  are  considered,  it  would  appear  that  implementing  a  gain-tuned 
UTAP  controller  enhanced  the  system  performance.  However,  there  is  no  evidence  to 
suggest  that  the  original  controller  was  gain-tuned  for  optimal  performance.  Normal 
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wear  of  the  system  would  require  that  the  gains  be  periodieally  tuned.  I  believe  that  the 
original  eontroller  requires  gain  tuning.  If  gain-tuning  of  the  original  controller  was 
accomplished,  I  would  expect  it  to  perform  better  than  the  gain-tuned  UTAP  controller, 
the  gain-tuned  original  controller  versus  the  post-gain  tuned  UTAP  controller  error  values 
would  be  similar  to  the  original  versus  pre-gain  tuned  values. 

III.2.3.  Step-Response 

As  stated  in  Section  III.  1.3. 2,  the  step  response  evoked  severe  oscillations  in 
joints  four,  five,  or  six.  Movement  of  joints  one,  two,  or  three  usually  caused  joint  four  to 
oscillate.  Movement  of  joints  four,  five,  or  six  would  cause  that  particular  joint  to 
oscillate.  The  oscillations  occurred  when  the  magnitude  of  a  commanded  joint  movement 
exceeded  a  certain  threshold.  The  threshold  varied  for  each  joint.  The  larger  joints,  joints 
one,  two,  and  three,  could  sometimes  be  moved  up  to  five  degrees  without  oscillations. 
Joints  four,  five,  and  six  could  rarely  be  moved  more  than  one  degree. 

While  investigating  the  oscillations,  I  found  that  they  could  be  induced  with  both 
the  original  and  the  modified  trajectory  generation  modules  under  the  UTAP-compliant 
controller.  However,  they  could  not  be  induced  with  either  module  under  the  original 
controller.  Eventually,  the  problem  was  isolated  to  the  controller  gains. 

When  the  Kp  and  values  were  reduced  and  the  Kj  value  was  set  to  zero  for 
joints  four,  five,  and  six,  the  oscillations  ceased  to  occur.  This  indicated  a  problem  in  the 
gain  tuning  procedures.  When  conducting  both  Klafter’s  and  the  modified  gain  tuning 
procedures,  the  trjjgen  module  was  used  to  move  the  joint.  In  both  cases  the  joint 
movement  lasted  1 .5  seconds.  The  movements  were  not  large  enough  or  fast  enough  to 


28 


induce  the  oscillations.  Additionally,  for  the  same  reasons  a  step  response  was  needed 
during  the  performance  measurements,  a  step  response  movement  should  have  been  used 
when  gain  tuning  the  controller.  Therefore,  a  better  method  for  gain  tuning  the  controller 
must  be  developed. 

When  experimenting  with  the  joint  four  gains,  I  found  that  the  Kp  and  Kj  gains 
could  be  set  to  125  and  3.5  respectively  and  the  Kj  gain  could  be  set  to  1.5  without  the 
oscillations  occurring.  When  Kj  was  set  above  1 .5  with  these  Kp  and  values,  evidence 
of  the  oscillations  began.  Therefore,  implementing  UTAP  limited  the  range  of  gain 
values  that  could  be  used  without  causing  oscillations.  By  limiting  the  gain  values,  it  is 
possible  that  the  joint  could  not  be  tuned  to  optimal  performance. 

III.3.  Summary 

This  chapter  has  presented  the  methods  used  to  obtain  the  performance 
measurements  of  Anchor’s  UTAP  implementation.  It  described  gain  tuning  the  controller 
and  obtaining  a  measurement  baseline.  This  was  followed  by  a  description  of  the 
measurement  of  the  two  types  of  step  response.  Some  other  tests  were  discussed  that 
proved  to  be  not  feasible. 

The  chapter  then  moved  on  to  analyze  the  data.  It  indicated  that  performance  was 
greatly  enhanced  by  gain  tuning  the  controller.  The  performance  was  enhanced  so  much 
that  it  appeared  to  perform  better  than  the  original  controller.  This  suggested  that  the 
original  controller  would  also  benefit  from  gain  tuning.  Gain  tuning  the  original 
controller  would  likely  return  the  performance  ratio  between  the  original  controller  and 
the  UTAP  controller  back  to  that  observed  by  Anchor. 
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The  step  response  testing  performed  on  the  UTAP  controller  identified  a  problem 
with  the  UTAP  controller  gains.  The  procedures  used  to  gain  tune  the  controller  did  not 
take  into  consideration  the  method  used  to  move  the  manipulator,  the  size  of  the 
movement,  or  the  speed  of  the  movement. 
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IV.  Implementation  of  UTAP  on  the  Adept  550  Manipulator 

This  chapter  presents  the  methods  used  to  implement  the  UTAP  specification  on 
the  Adept  550  manipulator.  It  describes  the  methods  involved  with  the  preparation  of  the 
application,  development  of  the  interface  layer,  testing,  and  performance  measurement. 
Next,  the  chapter  presents  an  analysis  of  the  performance  data. 

IV.l.  Methodology 

This  section  of  the  chapter  describes  the  implementation  of  the  UTAP 
specification  on  the  Adept  550  manipulator.  The  overall  approach  to  the  task  was  to  find 
an  existing  application  written  for  the  Adept  system,  convert  it  to  UTAP  compliance,  and 
develop  an  interface  layer  that  would  allow  the  UTAP-compliant  application  to  run  on  the 
Adept  system.  These  steps  are  described  below  and  are  followed  by  a  description  of  the 
methods  involved  with  the  performance  measurement  of  the  implementation. 

IV.  1.1.  Determination  of  the  Appropriate  Application 

There  were  three  major  criteria  to  consider  in  choosing  the  application.  First,  the 
application  must  incorporate  a  variety  of  functions  such  as  robot  control,  use  of  the 
manual  control  pendant  (MCP),  operator  input,  and  disk  file  10.  This  ensured  that  a 
respectable  portion  of  the  UTAP  specification  would  be  implemented.  Second,  the 
application  must  not  be  too  large  and  complex  or  there  would  not  have  been  time  to  finish 
the  project.  Third,  AFIT  must  have  legal  rights  to  use  and  alter  the  application. 

Previously,  ACG  had  provided  AFIT  with  numerous  applications  that 
demonstrated  various  capabilities  of  the  Adept  system.  After  reviewing  these 
applications,  I  found  that  they  were  either  too  complex  (several  thousand  lines  of  code)  or 
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too  specialized  (only  involved  robot  control  and  output  to  the  screen).  I  also  reviewed 
two  projects  from  the  Robotic  Fundamentals  course.  These  were  not  complex  enough  for 
this  purpose. 

The  application  eventually  chosen  was  one  I  had  written  during  a  V+ 
programming  course  given  by  Adept  Technologies.  The  primary  fimction  of  the 
application  is  to  move  parts  from  one  pallet  to  another.  Additional  functions  include 
MCP  control  of  the  application,  screen  display  of  location  information,  screen  display  of 
system  information,  and  writing  location  information  to  an  audit  trail  file.  I  also  added 
two  force  control  functions  to  the  application.  The  first  simulates  attempting  to  insert  a 
part  into  a  recess.  If  the  part  will  not  slide  into  the  recess  smoothly,  it  is  returned  to  the 
pallet  and  another  part  is  tried.  The  second  force  control  function  slowly  lowers  a  part  to 
the  work  surface.  It  uses  force  sensing  to  determine  when  the  part  is  sitting  on  the  work 
surface.  It  then  releases  the  part  and  moves  to  a  safe  position.  Appendix  G  contains  the 
original  source  code  for  the  application. 

IV.1.2.  Conversion  of  the  Application  to  UTAP  Compliance 

In  order  to  begin  the  conversion,  I  needed  to  decide  how  to  implement  the  UTAP 
messages.  Anchor  had  to  choose  between  using  Chimera’s  Interprocessor  Message 
Passing  or  implementing  them  as  subroutine  calls  [3].  The  choice  turned  out  to  be  very 
easy  since  V+  does  not  support  any  type  of  interprocess  messages.  Therefore,  the  only 
option  was  to  implement  the  UTAP  messages  as  V+  subroutine  calls.  A  small  problem 
did  arise  from  this.  V+  allows  a  subroutine  to  have  up  to  256  characters  in  its  name. 
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However,  V+  only  recognizes  the  first  15.  Therefore,  UTAP  messages  with  long  names 
could  be  interpreted  as  the  same  message.  For  example,  the  UTAP  messages  US_AXIS_ 
SERVO_USE_ABS_POSITION_MODE  and  US_AX1S_SERV0_USE_REL_ 
POSITION_MODE  would  be  interpreted  by  V+  as  the  same  message,  US_AXIS_ 
SERVO_U.  During  a  telephone  conversation,  John  Michaloski  of  the  Intelligent  Systems 
division  of  NIST  and  I  decided  that  the  best  alternate  would  be  to  abbreviate  the  message 
names.  Therefore,  “US_”  was  dropped  from  the  front  of  all  the  messages  implemented. 
Most  messages  also  have  a  three  letter  abbreviation  of  the  module  name  following  the 
“US_."  This  was  standardized  to  a  two  letter  abbreviation  as  shown  in  table  IV.  1 . 
Additionally,  other  words  were  abbreviated  as  needed.  For  example,  the  UTAP  message 
US_TLC_START_FINE_MOTION  became  tl_str_fine_mot.  Consistency  was 
maintained  in  all  the  abbreviations  made.  Appendix  C  contains  a  list  of  all  the  messages 
defined  in  the  UTAP  specification. 


UTAP  MODULE  NAME 

UTAP  ABBREVIATION 

V+  ABBREVIATION 

Analysis  &  Diagnostics 

ADS 

AD 

Object  Calibration 

OC 

OC 

Operator  Input  Devices 

01 

01 

Object  Knowledge 

OK 

OK 

Object  Modeling 

OM 

OM 

Parent  Task  Program  Sequencer 

PTPS 

PS 

Robot/Axis  Servo  Control 

RSC  (or  Axis  Servo) 

AS 

Sensor  Control 

SC  (or  Sensor) 

SC 

Status  Graphics  &  Display 

SGD 

SG 

Subsystem  Simulators 

SS 

SS 

Tool  Control 

TC 

TC 

Trajectory  Description 

TD 

TR 

Task  Description  &  Supervision 

TDS 

TD 

Task  Knowledge 

TK 

TK 

Task  Program  Sequencer 

TPS 

TS 

Subsystem  Task  Level  Control 

TLC 

TL 

Virtual  Sensor 

VS 

VS 

Table  IV.l.  UTAP  Module  Name  Abbreviations 
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Since  the  focus  of  the  UTAP  specification  is  on  the  interfaces,  conversion  of  the 


application  to  UTAP  compliance  was  approached  with  the  concept  that  anytime  the 
applieation  communicated  with  the  operating  system,  the  operator,  or  between  processes. 


the  communication  must  be  in  the  form  of  a  UTAP  message.  The  major  difficulty  was 
determining  which  UTAP  message  should  be  associated  with  each  V+  command  or 
system  call  used  in  the  application.  This  difficulty  arose  from  the  fact  that  the  UTAP 


specification  does  not  provide  the  meaning  or  usage  of  the  messages  it  imposes.  Table 


IV.2  shows  the  UTAP  messages  that  were  implemented. 


UTAP  MESSAGE 

V+  FUNCTION 
NAME 

V+  COMMAND 

AXIS_SERVO 

US_AXIS_SERVO_SET_POSITION 

as_set_position 

MOVE 

US_AXIS_SERVO_SET_VELOCITY 

assetvelocity 

SPEED 

GENERIC 

US_HOLD 

hold 

WAIT 

US_INIT_OK 

GLOBAL 

US_GET_EXT_DATA_VALUE 

get_ext_data 

PROMPT 

US_POST_EXT_DATA_VALUE 

postextdata 

TYPE 

OBJECT  KNOWLEDGE 

US_OK_ATTRIBUTE_QUERY 

okattribquery 

SPEED,  SWITCH,  CONFIG,... 

PROGRAMMABLE_IO 

US_PIO_BIT_READ 

pibitread 

SIG,  PENDANT 

US_PIO_BIT_SET 

pibitset 

KEYMODE 

US_PIO_DISABLE 

pidisable 

FCLOSE,  DETACH 

US_PIO_ENABLE 

pienable 

ATTACH 

US_PIO_SET_MODE 

pisetmode 

FOPENA,  FOPENR,  FOPENW 

PARENT  TASK  PROGRAM 
SEQUENCER 

US_PTPS_SELECT_AGENT 

psselectagent 

EXECUTE 

SENSOR 

US  SENSOR  GET  ATTRIBUTES 
READING 

sc^etattread 

FORCE.READ,  FORCE.OFFSET 

US_SENSOR_GET_READING 

scgetreading 

LATCH,  LATCHED,  FORCE.READ 

TASK  DESCRIPTION 

US_TDS_EXECUTE_PROGRAM 

td_exec_prog 

CALL 

TASK  LEVEL  CONTROL 

US_TLC_START_FINE_MOTION 

FINE 

Table  rv.2.  UTAP  Messages  Implemented 
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The  table  gives  the  UTAP  message  name,  the  V+  function  name,  and  the  V+ 
command  to  which  the  message  equates.  Additionally,  there  were  several  functions  that 
did  not  have  corresponding  UTAP  messages.  In  these  cases,  messages  were  created  to 
fill  the  needed  function.  Table  IV.3  lists  these  messages.  My  main  concern  while 
converting  the  application  code  to  UTAP  compliance  was  to  maintain  the  exact 
functionality  of  the  original  application.  This  would  aid  the  comparison  between  the 
performance  measurements  of  the  original  system  and  the  UTAP-compliant  system. 
More  importantly,  this  would  aid  in  proving  the  feasibility  of  UTAP.  If  an  operational 
system,  such  as  the  F-15  paint  booth,  were  being  converted  to  UTAP  compliance,  we 
certainly  could  not  change  the  functionality  of  the  system.  Appendix  H  contains  the 
source  code  for  the  UTAP-compliant  application. 


UTAP  MESSAGE 

V+  FUNCTION 
NAME 

V+  COMMAND 

GENERIC 

US_GET_EXT_LOCATION_DATA 

get_ext_loc_dat 

SET 

US_SET_EXT_LOCATION_DATA 

SET 

SENSOR 

US_FT_SENSOR_DISABLE 

FORCE.MODE 

US_FT_SENSOR_ENABLE 

FORCE.MODE 

US_FT_SENSOR_MODE_SELECT 

FORCE.MODE 

TOOL  CONTROL 

USGRIPPERCLOSE 

gripperclose 

SIGNAL  1 

US_GRIPPER_OPEN 

gripperopen 

SIGNAL -1 

Table  IV.3.  Additional  Messages  Created 


IV.1.3.  Development  of  the  Interface  Layer 

Once  the  application  had  been  re-written  to  be  UTAP-compliant,  a  program  layer 
needed  to  be  written  that  accepted  UTAP  messages  and  translated  them  into  V+ 


35 


commands.  The  interface  layer  consists  of  a  set  of  V+  program  files  and  each  program 
file  corresponds  to  a  UTAP  module.  For  example,  the  program  file  pi.pg  contains  the  V+ 
code  that  implements  the  functionality  of  the  UTAP  programmable  input/output  module. 
The  following  sections  discuss  general  issues  common  to  all  the  modules  and  the  specific 
issues  related  to  each  module.  Throughout  this  chapter  I  will  refer  to  message  names. 
When  doing  so,  the  V+  function  name  will  be  used,  not  the  UTAP  message  name.  This 
will  make  it  easier  for  the  reader  to  locate  the  message  within  the  interface  layer  V+ 
programming  code  (Appendix  I). 

IV.1.3.1.  General  Programming  Issues 

While  developing  the  interface  layer,  I  incorporated  programming  techniques  that 
ensured  the  easy  expansion  of  the  layer  in  the  event  that  additional  UTAP  messages  need 
to  be  implemented.  For  example,  one  of  the  parameters  of  the  GET_EXT_DATA 
message  is  “channel.”  For  the  application  selected,  the  keyboard  is  the  only  channel  that 
inputs  data  via  the  GET_EXT_DATA  message.  However,  within  the  code  for  the 
GET_EXT_DATA  message,  I  used  a  case  statement  based  on  the  channel  to  the  select  the 
operations  that  need  to  be  completed.  The  keyboard  section  is  the  only  one  implemented, 
but  adding  the  MCP,  file,  or  other  charmel  would  be  much  easier  under  this  design. 

Several  new  messages  were  added  to  those  defined  by  the  UTAP  specification. 
When  this  was  done,  the  naming  conventions  used  throughout  the  UTAP  specification 
were  adhered  to. 
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IV.1.3.2.  Axis  Servo  Module 


Two  UTAP  messages  were  implemented  from  the  axis  servo  module  message  list. 
Both  messages  were  direct  mappings  to  V+  commands.  Of  special  interest  was  the 
parameter  to  the  AS_SET_POSITION  message.  The  UTAP  specification  defines  the 
parameter  to  this  message  as  a  pointer  to  a  double  precision  number.  Instead,  it  was 
implemented  as  a  V+  transformation  location  variable  indicating  a  desired  manipulator 
position.  This  was  an  example  of  the  UTAP  message  name  and  parameters  not  matching 
the  desired  use  of  the  message.  However,  a  more  suitable  message  could  not  be  found,  so 
this  one  was  chosen.  See  Appendix  B  for  a  definition  of  the  different  V+  location 
variable  types. 

IV.1.3.3.  Generic  Module 

This  module  implements  a  portion  of  the  generic  messages  defined  by  the  UTAP 
specification.  The  get_ext_data  message  was  used  to  get  operator  input  fi-om  the 
keyboard  and  the  post_ext_data  message  was  used  to  send  output  to  the  screen,  MCP,  or 
file.  It  is  possible  that  the  Operator  Interface  module  should  contain  messages  that  serve 
the  input  and  output  functions  implemented  here.  However,  the  UTAP  specification  did 
not  provide  such  messages  in  the  01  module,  but  instead  placed  these  messages  in  the 
UTAP  Data  Definitions  module.  Two  messages  were  added  to  this  module  that  were  not 
defined  by  the  UTAP  specification:  get_ext_loc_dat  and  set_ext_loc_dat.  These 
messages  are  used  to  store  and  retrieve  V+  transformation  location  variables.  The  UTAP 
specification  does  not  have  messages  of  this  type  with  the  appropriate  parameters. 
Therefore,  I  was  forced  to  create  the  new  messages. 
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IV.1.3.4.  Object  Knowledge  Module 

The  purpose  of  the  Object  Knowledge  module  is  to  store  and  maintain  specific 
knowledge  of  the  various  objects  forming  the  entire  system.  This  includes  manipulator 
information  such  as  model  number  as  well  as  information  about  the  part  being  worked  on 
such  as  shape,  mass,  or  hardness.  For  the  purposes  of  this  research,  only  the  portions  of 
the  Object  Knowledge  module  needed  for  the  application  were  implemented.  Therefore, 
the  messages  implemented  in  this  module  are  the  ones  used  to  access  system  information. 
IV.1.3.5.  Programmable  Input/Output  Module 

The  messages  in  this  module  were  used  to  enable,  disable,  and  set  the  mode  of  the 
disk  access  and  MCP.  Also,  they  are  used  to  read  data  from  and  write  data  to  the  MCP, 
signals,  and  system  timers. 

IV.1.3.6.  Parent  Task  Program  Sequencer  Module 

A  typical  robotic  application  will  have  several  different  processes  controlling 
different  aspects  of  the  overall  task.  The  palletizing  application  chosen  uses  separate 
processes  to  control  the  manipulator,  manage  the  MCP,  display  the  coordinate 
information,  and  display  system  information.  The  Parent  Task  Program  Sequencer 
module  manages  the  processes'  execution  sequence.  Since  it  was  the  appropriate  location 
for  this  type  of  message,  the  ps_select_agent  message  was  used  to  start  the  execution  of 
additional  processes. 

IV.1.3.7.  Sensor  Module 

The  UTAP  specification  is  lacking  in  force/torque  sensor  messages.  Therefore,  I 
was  required  to  create  three  new  messages  in  this  module.  The  messages  are  used  to 
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enable,  disable,  and  select  the  mode  of  a  force/torque  sensor.  Existing  UTAP  messages 
were  used  to  read  the  values  from  the  sensor. 

IV.1.3.8.  Tool  Control  Module 

The  UTAP  specification  focuses  primarily  on  aircraft  painting  and  stripping 
operations.  Thus,  tool  control  messages  are  only  defined  for  spindle  and  flow  type  tools, 
such  as  Sanders  and  paint  guns.  For  this  reason,  I  was  required  to  define  two  new 
messages  for  gripper  operation;  gripper_open  and  gripper_close.  These  messages  are 
simple  mappings  to  V+  gripper  commands. 

IV.1.3.9.  Task  Description  Module 

The  Task  Description  module  maintains  information  about  what  the  task  needs  to 
accomplish.  As  a  part  of  that,  the  module  determines  which  subroutines  should  be  used 
and  when.  The  td_exec_prog  message  was  part  of  this  module  and  mapped  directly  to  the 
V+  “call”  command  for  initiating  subroutines. 

IV.1.3.10.  Task  Level  Control  Module 

The  Task  Level  Control  module  manages  the  events  within  each  process.  It 
controls  positioning  modes,  motion  types,  feed  rates,  etc.  The  tl_str_fine_mot  message 
was  a  direct  mapping  to  the  V+  FINE  command. 

IV.1.4.  Testing 

Testing  occurred  throughout  the  development  of  the  interface  layer.  Each  UTAP 
message  was  individually  tested  to  ensure  appropriate  functionality.  As  stated  earlier,  an 
important  part  of  my  effort  was  to  make  sure  that  the  UTAP-compliant  version  of  the 
application  produced  the  exact  same  results  as  the  original  version.  With  this  in  mind,  I 
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wrote  test  drivers  for  each  implemented  message.  The  test  driver  would  execute  a  V+ 
command  or  set  of  commands  and  then  execute  the  UTAP  message  corresponding  to  the 
commands.  I  would  then  compare  the  output  of  each  to  ensure  they  matched.  I  used 
input  values  such  that  all  categories  of  outcome  were  experienced. 

Once  all  the  messages  had  been  tested  separately,  I  began  combining  them  to 
ensure  they  functioned  together  as  expected.  Again,  I  used  test  drivers  to  test  the  range  of 
input  and  output  possibilities. 

After  the  individual  tests  were  complete,  I  loaded  the  application  and  the  interface 
layer  and  executed  the  application.  I  tested  each  function  of  the  application  to  ensure  it 
performed  as  expected  and  the  output  matched  that  of  the  original  application. 

IV.1.5.  Performance  Measurement 

Performance  of  the  implementation  was  measured  in  four  different  ways.  First, 
the  number  of  source  lines  of  code  (SLOC)  in  the  original  and  the  UTAP-compliant 
versions  of  the  application  were  compared.  V+  is  an  interpretive  language.  This  means 
that  a  program’s  source  code  is  not  compiled  into  some  form  of  machine  language. 
Instead,  each  line  of  the  program  is  parsed  as  execution  occurs.  The  V+  system  pre- 
processes  one  line  ahead  of  the  current  execution.  Source  code  optimization  could  not  be 
accomplished  by  the  system  due  to  the  interpretive  nature  of  the  language.  Therefore,  the 
SLOC  number  can  provide  meaningful  insight  into  the  complexity  of  a  program. 

The  second  measurement  conducted  was  a  calculation  of  the  architectural  design 
complexity  of  the  source  code  using  Card  and  Agresti’s  method  [4]  and  provided  a 
measure  of  the  software  quality.  The  method  calculates  the  complexity  of  a  design  by 
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computing  and  slimming  two  values.  The  first  value  defines  the  structural  complexity  of 
the  code.  It  is  derived  from  the  relationships  between  the  modules  of  a  system.  The 
relationships  are  quantified  by  squaring  the  number  of  modules  called  by  each  module 
(called  the  fanout  or  and  dividing  the  sum  of  the  squares  by  the  number  of  modules  (n) 

y  f. 

to  normalize  the  value.  Thus,  the  formula  for  structural  complexity  is:  S  =  f .  The 

n 

second  value  is  the  local  complexity.  This  value  indicates  the  amount  of  complexity 
ivithin  each  module  and  is  measured  based  on  the  amount  of  work  performed  within  the 
module.  The  workload  is  calculated  based  on  the  number  of  input  and  output  variables 
associated  with  the  module  (v,)  and  the  amount  of  work  passed  to  other  modules.  The 
amount  of  work  passed  is  quantitized  by  the  same  fanout  value  if)  used  in  the  calculation 
of  S.  The  whole  value  is  normalized  over  the  number  of  modules  (n).  Thus,  the  formula 

^  f  +\ 

for  local  complexity  is:  L  =  — — - .  These  two  values  are  added  to  give  the  total 

n 

complexity  of  the  code:  C  =  S  +  L.  The  important  thing  to  remember  is  that  complexity 
measurement  is  simply  one  way  to  gage  the  quality  of  a  software  package.  High 
complexity  within  a  software  package  indicates  that  the  software  is  susceptible  to  more 
design  errors  and  will  be  more  difficult  to  maintain. 

The  third  measure  of  performance  I  gathered  was  the  amovmt  of  system  random 
access  memory  (RAM)  needed  by  the  original  and  UTAP-compliant  versions  of  the 
application.  Robotic  systems  have  a  finite  amount  of  RAM.  If  UTAP  compliance 


41 


required  too  much  RAM,  then  the  feasibility  of  the  specification  (on  Adept  systems) 
would  be  in  question. 

Finally,  the  fourth  and  most  important  measurement  involved  timing  the  two 
versions  of  the  application.  V+  has  built-in  timers  that  can  be  used  in  programs.  One  of 
these  timers  was  used  to  measure  the  execution  time  of  each  of  the  two  versions  of  the 
application.  To  ensure  that  operator  response  time  was  not  involved  in  the  times,  the 
timer  was  initialized  just  after  the  last  operator  input  was  entered.  The  timer’s  value  was 
then  displayed  when  execution  finished. 

Since  the  execution  time  varied  depending  on  the  starting  pallet,  I  timed  both 
versions  with  both  pallets  as  starting  points.  Both  versions  were  timed  at  25,  50,  75,  and 
100  percent  of  maximum  speed.  Five  measurements  were  collected  for  each  scenario. 

The  amount  of  time  a  program  takes  is  a  much  more  concrete  figure  than  the 
number  of  source  lines  of  code  or  complexity  values  involved  with  a  program.  This 
figure  gives  a  vivid  view  of  the  amount  of  overhead  added  to  the  application  by  UTAP 
compliance. 

IV.2.  Analysis 

This  section  presents  the  data  obtained  while  measuring  the  performance  of  the 
Adept  550  UTAP  Implementation.  The  number  of  source  lines  of  code  is  the  first  data 
presented.  Next,  I  address  the  Card  and  Agresti  complexity  metrics.  Third,  the  amount 
of  random  access  memory  used  is  presented.  Finally,  the  execution  time  data  is 
discussed. 
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IV.2.1.  Source  Lines  of  Code 


There  were  434  total  source  lines  of  code  for  the  non-UTAP  version  of  the 
application.  The  UTAP  version  of  the  application  had  769  lines  of  code.  Although  the 
number  of  code  lines  almost  doubled,  we  must  consider  that  the  number  for  the  UTAP 
version  includes  303  lines  of  code  that  comprise  the  UTAP  interface  layer.  Any  new 
operating  system  that  is  developed  to  be  UTAP-compliant  will  not  require  an  interface 
layer.  Therefore,  if  the  interface  layer  is  considered  as  part  of  the  operating  system,  then 
the  UTAP  version  only  had  466  source  lines  of  code.  This  is  only  32  lines,  or  7  percent, 
more  that  the  original  version. 

IV.2.2.  Complexity  Measures 

Following  the  method  for  computing  the  complexity  measures  as  described  in 
Chapter  III,  we  fine  that  the  original  application  had  a  structural  complexity  of  5.78  and  a 
local  complexity  of  1.65.  This  equals  a  total  design  complexity  of  7.43.  When  applied  to 
the  interface  layer  and  the  UTAP  application  combined,  the  method  yields  a  structural 
complexity  of  10.88,  a  local  complexity  of  1.49,  and  a  total  design  complexity  of  12.37. 
These  values  indicate  that  the  UTAP  version  has  a  much  more  complex  design  than  the 
original  version.  Once  again,  we  can  consider  the  interface  layer  part  of  the  operating 
system.  When  this  is  done,  the  UTAP  application  has  a  structural  complexity  of  5.78,  a 
local  complexity  of  2.00,  and  a  total  design  complexity  of  7.78.  Comparing  these  values 
to  those  of  the  original  application,  we  see  that  the  structural  complexity  is  the  same  for 
both.  The  additional  complexity  of  the  UTAP  application  lies  in  the  local  complexity. 
The  structural  complexity  is  the  same  because  the  calls  to  the  UTAP  interface  are 
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considered  operating  system  ealls.  Operating  system  calls  are  not  considered  when 
computing  fanout.  Therefore,  the  original  and  the  UTAP  applications  have  the  same 
fanout  and  the  structural  complexities  are  the  same.  The  local  complexity  is  higher  for 
the  UTAP  application  because  it  uses  more  global  variables  than  the  original  application. 
Several  of  these  global  variables  are  used  to  indicate  the  channel  name  parameter  in  a 
UTAP  message.  In  a  UTAP-compliant  operating  system,  the  channel  names  would  not 
be  considered  global  variables.  If  we  did  not  count  these  as  global  variables  when 
computing  the  local  complexity  of  the  UTAP  application,  the  local  complexity  value 
would  be  much  closer  to  that  of  the  original  application.  The  similarity  in  the  complexity 
measures  of  the  original  and  the  UTAP  applications  indicates  that  developing  and 
maintaining  a  UTAP-compliant  application  will  not  be  any  more  difficult  than 
implementing  a  non-UTAP-compliant  application. 

IV.2.3.  Random  Access  Memory 

The  original  application  required  29.297  kilobytes  of  random  access  memory 
(RAM).  The  UTAP  application  and  interface  layer  combined  required  41.815  kilobytes 
of  RAM.  Again,  we  can  view  the  interface  layer  as  part  of  the  operating  system.  The 
UTAP  application  alone  required  30.332  kilobytes  of  RAM.  Comparing  this  to  the 
amount  of  RAM  required  by  the  original  application,  we  find  there  is  only  a  1.035 
kilobyte  increase.  This  equates  to  only  a  3.5  percent  increase  over  the  original 
application. 
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IV.2.4.  Execution  Time 


The  execution  times  for  the  original  and  the  UTAP  applications  are  given  in  Table 
IV. 4.  The  1  2  column  indicates  moving  the  parts  from  pallet  one  to  pallet  two.  The 

2  1  column  indicates  moving  the  parts  from  pallet  two  to  pallet  one.  All  times  are  in 

seconds. 


Speed: 

100 

Speed: 

75 

Original 

UTAP 

Original 

UTAP 

1  ^2 

2->  1 

1  ^2 

2-^1 

1  ^2 

2^1 

1  -^2 

2^1 

81.049 

85.330 

91.081 

95.514 

91.978 

98.330 

101.936 

108.500 

81.199 

85.877 

91 .249 

95.339 

91.928 

98.674 

101.969 

108.591 

81.043 

84.878 

91.288 

95.849 

91 .890 

98.698 

101.869 

108.457 

80.923 

84.857 

91.316 

95.697 

91.649 

98.551 

101.861 

108.764 

81.150 

85.024 

91 .352 

95.631 

91 .853 

98.646 

101.697 

108.563 

Ave: 

81.073 

85.193 

91.257 

95.606 

Ave: 

91.860 

98.580 

101.866 

108.575 

Speed: 

50% 

Speed: 

25% 

Original 

UTAP 

Original 

UTAP  1 

1  ->2 

2^1 

1  ^2 

2^1 

1  ^2 

2^1 

1  -^2 

2^1 

113.625 

125.905 

123.968 

135.033 

191.686 

212.138 

199.038 

219.406 

114.199 

125.749 

124.082 

134.824 

191.749 

212.133 

198.994 

219.449 

114.559 

125.820 

124.334 

134.804 

191.666 

212.138 

199.031 

219.488 

114.413 

125.751 

124.090 

135.155 

191.689 

212.159 

199.013 

219.650 

114.816 

125.689 

123.971 

135.242 

191.712 

212.132 

199.055 

219.546 

Ave: 

114.322 

125.783 

124.089 

Ave: 

191.700 

212.140 

199.026 

219.508 

Table  IV.4.  Execution  Times  (seconds) 


Table  IV.5  shows  the  differences  in  execution  times  between  the  original  and  the  UTAP- 
compliant  application.  The  values  were  obtained  by  subtracting  the  execution  time  of  the 
original  application  from  the  execution  time  of  the  UTAP  application.  From  this  table,  it 
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can  be  seen  that,  at  all  speeds,  the  original  application  runs  faster  than  the  UTAP 
application. 


Percentage  of  Maximum  Speed 

100% 

75% 

50% 

25% 

1  -»2 

10.184 

10.007 

9.767 

7.326 

2^1 

10.413 

9.995 

9.229 

7.368 

Average 

10.299 

10.001 

9.498 

7.347 

Table  IV.5.  Execution  Time  Differences  (seconds) 


This  was  expected  because  of  the  increased  processing  required  by  the  additional  lines  of 
code  in  the  UTAP  application.  It  is  also  noticeable  that,  as  the  speed  decreases,  the  time 
difference  between  the  original  and  the  UTAP  applications  decreases.  The 
implementation  of  UTAP  on  the  Adept  system  did  not  affect  the  time  required  to  move 
the  manipulator  from  one  position  to  another.  The  added  time  required  by  the  UTAP 
application  is  a  result  of  processing  the  additional  lines  of  code.  V+  continues  to  proeess 
program  lines  concurrent  with  robot  motion  as  long  as  the  lines  do  not  require  robot 
position  information,  sensor  information,  or  cause  another  robot  motion.  Because  of  this, 
slower  robot  speeds  allow  more  program  processing  during  robot  movement.  Therefore, 
the  smaller  difference  between  execution  times  of  the  original  and  the  UTAP  applications 
during  slower  robot  movement  is  explained  by  the  increased  processing  time  available 
during  the  robot  movements. 

Counting  the  interface  layer,  the  UTAP  application  had  335  more  lines  of  eode 
than  the  original  application.  At  maximum  speed,  the  UTAP  application  took 
approximately  10.3  seconds  longer  to  execute  than  the  original  application.  Using  these 
values,  we  can  determine  that  each  additional  line  of  code  adds  30.7  milliseconds  to  the 
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execution  time.  At  25  percent  of  maximum  speed,  the  UTAP  application  took 
approximately  7.3  seconds  longer.  At  this  speed,  each  additional  line  of  code  adds  21.8 
milliseconds  to  the  execution  time.  Even  if  we  add  1000  lines  of  code  when  we  convert 
an  application  to  UTAP  compliance,  we  only  add  31  seconds  to  the  execution  time.  Of 
course,  this  assumes  we  are  using  V+,  we  have  the  same  ratio  of  amount  of  movement  to 
lines  of  code,  and  we  use  the  larger  value  above  to  calculate  the  additional  time. 

IV.3.  Summary 

This  chapter  presented  the  methods  used  to  implement  the  UTAP  specification  on 
the  Adept  manipulator.  It  presented  the  application  chosen  to  convert  to  UTAP 
compliance  and  some  of  the  difficulties  faced  during  the  conversion.  The  interface  layer 
and  how  it  was  developed  was  then  described.  The  chapter  then  gave  a  discussion  of  the 
test  procedures  and  the  performance  measurements  of  the  system. 

The  data  obtained  while  measuring  the  Adept  UTAP  performance  was  then 
presented.  It  showed  that  the  system  performance  was  degraded  by  the  implementation 
of  UTAP.  When  comparing  the  original  system  to  the  UTAP  application  and  the 
interface  layer,  performance  degradation  seemed  high.  However,  the  interface  layer 
would  not  exist  in  a  purely  UTAP-compliant  operating  system.  Thus,  the  original 
application  can  be  compared  to  just  the  UTAP  application  and  the  interface  layer  viewed 
as  part  of  the  operating  system.  Under  these  circumstances,  the  UTAP  application 
showed  very  little  performance  degradation.  This  indicates  that  retrofitting  an  existing 
robot  system  to  UTAP  would  likely  be  unfeasible  due  to  the  performance  issues. 
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However,  a  new  robotie  system  design  that  incorporated  UTAP  would  not  have  the 
performance  degradation  and  would  be  feasible. 
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V.  Conclusions  and  Recommendations 


V.l.  Conclusions 

Several  conclusions  can  be  made  from  this  thesis  effort.  First  and  foremost, 
implementing  UTAP  on  two  vastly  different  systems  has  shown  that  UTAP  is  a  feasible 
telerobotic  control  architecture.  Both  systems  were  made  UTAP-compliant  for  specific 
applications  and  the  applications  continued  to  performed  all  original  tasks. 

As  expected,  retrofitting  both  the  Chimera  system  and  the  Adept  system  to  UTAP 
compliance  adversely  affected  the  system  performance.  Unfortunately,  difficulties  with 
the  Chimera  system  hindered  the  quantification  of  the  performance  degradation.  Gain 
tuning  Anchor’s  UTAP-compliant  controller  greatly  improved  it’s  performance. 
However,  the  data  indicated  that  the  original  controller  also  needed  gain  tuning.  The 
performance  ratio  between  it  and  the  UTAP  controller  would  likely  be  returned  back  to 
that  observed  by  Anchor  by  gain  tuning  the  original  controller. 

Implementing  UTAP  on  the  Adept  system  has  shown  that  retrofitting  a  system 
adds  large  eimounts  of  overhead  in  the  form  of  the  interface  layer.  However,  a  system 
designed  for  UTAP  compliance  from  the  start  will  not  have  that  overhead.  Therefore, 
such  a  system  should  be  able  to  perform  as  well  as  a  non-compliant  system. 

The  data  obtained  from  the  complexity  measurements,  source  lines  of  code 
calculations,  and  RAM  measurements  of  the  Adept  implementation  indicates  that 
developing  and  maintaining  a  UTAP-compliant  application  will  not  be  any  more  difficult 
than  implementing  a  non-UTAP-compliant  application. 
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UTAP  begins  the  telerobotic  control  architecture  standardization  effort.  However, 
it  has  a  long  way  to  go.  But,  the  effort  has  to  start  somewhere  and  UTAP  has  made  a 
good  start.  It  addresses  the  same  goals  as  other  successful  standardization  efforts  and 
provides  the  building  blocks  to  achieve  those  goals.  With  a  continued  effort  to  remove 
the  inconsistencies  in  the  UTAP  specification  and  to  provide  the  meaning  behind  each 
message,  UTAP  can  make  the  next  step  towards  standardizing  the  robotics  community. 
V.2.  Recommendations 

V.2.1.  Improvements  to  the  UTAP  Specification 

Determining  the  purpose  of  each  UTAP  message  and  which  message  to  use  for  a 
particular  task  was  the  most  difficult  part  of  this  thesis  effort.  The  UTAP  specification 
states  that  “the  intent  and  meaning  of  UTAP  API  messages  shouldht  apparent  from  the 
message  name”  [9].  For  most  of  the  messages,  this  is  true.  However,  finding  the 
appropriate  message  for  even  basic  tasks  was  sometimes  difficult.  For  example,  to  move 
joint  one  of  the  manipulator,  should  the  US_AXIS_SERVO_SET_POSITION  message  or 
the  US_TLC_START_AUTOMATIC_MOTION  message  be  used?  What  about  the 
US_TLC_START_MANUAL_MOTION  message?  The  UTAP  specification  should 
clearly  define  every  message.  The  purpose  of  the  message  should  be  explicitly  stated  and 
guidelines  presented  for  the  use  of  the  message.  Additionally,  the  parameters  associated 
with  each  message  should  be  completely  described,  including  whether  they  are  input  or 
output  parameters  and,  where  possible,  the  expected  range  of  values. 

In  addition  to  defining  the  messages,  the  UTAP  specification  should  define  the 
purpose  of  each  UTAP  module.  I  had  expected  the  Operator  Interface  module  to  contain 
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messages  related  to  the  input  and  output  of  information  between  the  system  and  the 
operator.  However,  the  speeifieation  does  not  define  messages  for  these  tasks  under  this 
module.  This  may  not  be  the  purpose  of  this  module.  The  specification  does  not  make 
the  purpose  of  this  or  other  modules  clear.  Clarifying  each  module’s  purpose  would  aid 
the  understanding  of  the  messages  contained  within  the  module.  Implementors  would 
also  be  less  likely  incorporate  into  a  module  the  wrong  functionality. 

Focusing  on  “what  to  pass”  rather  than  “how  to  pass”  allows  the  specification  to 
remain  generalized.  However,  an  implementation  depends  on  the  decision  of  “how  to 
pass.”  A  UTAP-compliant  application  based  on  passing  information  and  control  flow  via 
function  calls  will  not  run  on  a  system  that  uses  message  passing.  The  UTAP 
specification  must  specify  one  or  the  other  method  or  it  must  state  that  UTAP-compliant 
systems  must  accommodate  applications  using  either  method. 

Anchor  correctly  states  that  “the  UTAP  document  is  'C-centric',  but  the 
specification  is  intended  to  be  language-independent”  [3].  The  examples  and  message 
definitions  should  be  modified  as  Anchor  suggests.  I  recommend  using  some  form  of 
pseudo-code. 

V.2.2.  Future  Research 

A  valid  method  for  gain  tuning  the  Chimera/PUMA  system  should  be  developed. 
The  method  should  then  be  used  to  tune  both  the  UTAP-compliant  and  the  non-UTAP- 
compliant  controllers.  Once  both  controllers  are  tuned,  the  performance  of  the  UTAP- 
compliant  controller  could  be  more  accurately  quantified. 
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Capt  Lemley’s  research  efforts  toward  designing  a  purely  UTAP-compliant 
operating  system  (OS)  should  be  continued  [8].  The  OS  should  be  developed  for  a 
hardware  platform  that  has  an  existing  non-UTAP  robotic  control  OS.  Once  the  UTAP- 
compliant  OS  is  in  place,  applications  could  be  written  with  identical  functionality  for 
both  the  UTAP-compliant  OS  and  the  original  OS.  Neither  application  would  require  an 
interface  layer  since  they  both  were  written  for  their  native  OS.  Comparing  the 
performance  of  the  two  applications  would  define  the  impact  on  the  system  levied  by 
UTAP  conformance. 

Finally,  the  Adept  UTAP  implementation  should  be  expanded  to  include  more  of 
the  messages  defined  by  the  UTAP  specification.  This  would  further  cement  the 
feasibility  of  UTAP  and  provide  more  data  on  the  performance  issues. 

V.3.  Summaty 

Table  V.l  provides  a  summary  of  the  conclusions  of  this  thesis.  Table  V.2 
summarizes  my  recommendations  for  improvements  to  the  UTAP  specification  and 
Table  V.3  summarizes  my  recommendations  for  future  research.  This  thesis  effort 
investigated  the  feasibility  of  the  Unified  Telerobotic  Architecture  by  implementing  the 
UTAP  specification  on  an  existing  robotic  system  and  measuring  the  performance  of  this 
and  a  previous  implementation.  This  effort  has  shown  that  the  architecture  is  feasible  but 
requires  additional  clarification.  This  thesis  has  also  shown  that  retrofitting  existing 
systems  exacts  a  heavy  performance  toll  on  the  system,  but  designing  a  new  system  to  be 
UTAP-compliant  is  an  appropriate  activity  to  pursue.  The  results  of  this  thesis  will  aid  in 
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making  the  decision  to  continue  pursuing  the  UTAP  specification  as  an  Air  Force 


standard. 


Conclusions 

1 

Gain  tuning  improved  the  performance  of  Anchor’s  UTAP  controller 

2 

The  original  controller  needs  be  have  the  gains  tuned 

3 

Tuning  the  original  controller  would  return  the  performance  ratio 
between  it  and  Anchor’s  back  to  ratio  observed  by  Anchor 

■i 

UTAP  is  a  feasible  telerobotic  control  architecture 

5 

Retrofitting  a  system  adversely  affects  its  performance 

6 

A  system  designed  from  the  beginning  to  be  UTAP-compliant  will  not 
have  the  adverse  performance  effects 

7 

Developing  applications  for  a  UTAP-compliant  system  is  not  any  more 
difficult  than  developing  applications  for  a  non-UTAP-compliant  system 

Table  V.l.  Summary  of  Conclusions 


Recommendations 

1 

Explicitly  define  each  UTAP  message  including  the  parameters 

2 

Explicitly  define  each  UTAP  module  including  the  functions  and 
purpose 

3 

Decide  on  a  message  passing  format  or  state  that  both  must  be  supported 

mm 

Use  pseudo-code  instead  of  C  code  for  examples 

Table  V.2.  Summary  of  Recommendations  for  the  UTAP  Specification 


Recommendations 

1 

Develop  a  gain  tuning  method  and  conduct  further  measurements  on 
Anchor’s  UTAP-compliant  controller 

2 

Continue  Capt  Lemley’s  development  of  an  originally  designed  UTAP- 
compliant  system 

3 

Expand  the  Adept  UTAP  implementation 

Table  V.3.  Summary  of  Recommendations  for  Future  Research 
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APPENDIX  A 

V+/UTAP  System  Users  Manual 

Note:  User  input  and  system  prompts  are  shown  in  a  different  font  than  the  rest  of  the  test.  User  input  is 
also  shown  in  boldface.  Text  in  italics  represents  a  place  holder  for  some  other  test  (i.e.,  a  variable 
name). 

Adept  System  Power-up  and  Calibration 

Steps: 

1 .  Tiom  the  Adept  system’s  power  switeh  to  “On”. 

2.  Plug  in  the  air  dryer  power  cord. 

3 .  Open  the  air  valve  on  the  compressor  tank. 

4.  Turn  the  compressor  power  switch  to  “Auto”. 

5.  Open  both  air  valves  located  at  the  back  of  the  manipulator  table. 

6.  Enable  power  to  the  manipulator  by  typing  the  following  at  the  monitor  prompt: 

.  enable  power 

7.  Calibrate  the  Adept  manipulator  by  typing  the  following  at  the  monitor  prompt: 

.  calibrate 

8.  Confirm  that  calibration  should  occur  by  responding  with  a  “y”: 

Are  you  sure  (y/n):  y 

Loading  the  V+/UTAP  Interface 

Steps: 

1 .  Change  to  the  UTAP  directory  by  issuing  the  following  monitor  command: 

.  def  =  c:\utap 
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2.  Load  the  V+/UTAP  interface  modules  into  system  memory.  Each  module  can  be 
loaded  individually  with  the  load  command.  For  example,  the  sensor  module  can  be 
loaded  with  the  following  command: 

.  load  sc.pg 

A  script  can  be  used  to  load  all  of  the  modules  instead  of  loading  them  individually. 
This  is  accomplished  -with  the  following  commands: 

.  load  utap.pg 
.  commands  setup 

At  this  point,  a  UTAP-compliant  application  can  be  loaded  and  executed. 


Loading  and  Executing  an  Application 

Steps: 

1 .  Change  to  the  directory  containing  the  application.  For  example,  the  following 
command  will  change  to  the  directory  containing  a  palletizing  application: 

.  def  =  c:\utap\app 

2.  Load  the  application  into  system  memory  using  the  load  command.  The  UTAP- 
compliant  palletizing  application  is  loaded  as  follows: 

.  load  demo.v2 
.  load  pallet.pg 
.  load  force.pg 

3 .  Begin  application  execution  by  issuing  the  execute  command  with  the  main 
program.  The  palletizing  application  is  started  with  the  following  command: 

.  execute  utap.demo 


Adept  System  Shutdown 

Steps: 

1 .  Close  the  air  valves  on  the  back  of  the  manipulator  table. 
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2.  Turn  the  air  compressor  power  switch  to  “Off’. 

3.  Close  the  air  valve  on  the  compressor  tank. 

4.  Unplug  the  air  dryer. 

5.  Turn  the  Adept  System  power  switch  to  “Off’. 
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APPENDIX  B 


Adept  V+  Tutorial 


I.  Introduction. 

V+  is  Adept  Technology’s  proprietary  control  system  and  programming  language  used 
with  their  industrial  robots.  This  tutorial  presents  exerpts  and  information  from  the  V+ 
Language  User’s  Guide  [1]  and  the  V+  Quick  Reference  Guide  [2].  It  presents  the  basic 
information  needed  to  operate  and  program  the  Adept  550  manipulator.  The  tutorial  is 
divided  into  three  sections.  The  first  section  covers  general  V+  issues.  The  second 
section  describes  the  basic  control  system  commands  (called  monitor  commands).  The 
third  section  describes  some  programming  language  commands  (called  language 
commands). 

II.  General  V+ Issues 

11.1.  Program  Types 

There  are  two  types  of  V+  programs,  executable  and  command. 

11.1.1.  Executable  Programs 

There  are  two  classes  of  executable  programs,  robot  control  programs  and  general 
programs.  A  robot  control  program  is  a  V+  program  that  directly  controls  a  robot.  A 
general  program  is  any  program  that  does  not  control  a  robot.  A  mixture  of  robot  control 
and  general  programs  can  execute  at  the  same  time,  but  only  one  robot  control  program 
can  have  control  of  the  robot  at  any  given  time.  Robot  control  programs  can  contain  any 
of  the  V+  program  instructions.  With  the  exception  of  the  BRAKE  instruction,  a  general 
program  cannot  execute  any  instruction  that  affects  the  robot  motion.  They  can  access  all 
other  V+  features  including  AdeptVision,  digital  signal  lines,  and  the  manual  control 
pendant.  Executable  programs  are  initiated  by  the  EXECUTE  monitor  command. 

11.1.2.  Command  Programs 

Command  programs  are  similar  to  MS  DOS  batch  programs  or  UNIX  scripts.  They  can 
contain  any  monitor  command  and  can  access  language  commands  through  the  monitor 
DO  command.  Command  programs  are  initiated  by  the  COMMANDS  monitor 
command. 
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II.2.  Data  Types 

11.2.1.  Declaration  and  Allocation 

V+  does  not  require  you  to  declare  variables  or  their  data  types.  The  first  use  of  a 
variable  will  determine  its  data  type  and  allocated  space  for  that  variable. 

11.2.2.  Variable  Name  Requirements 

The  requirements  for  a  valid  variable  name  are: 

1 .  Adept  reserved  keywords  cannot  be  used. 

2.  The  first  character  of  a  variable  name  must  be  a  letter. 

3.  The  characters  after  the  first  character  may  be  letters,  numbers,  periods,  and  the 
underline  character. 

4.  Only  the  first  1 5  characters  in  a  variable  name  are  significant. 

11.2.3.  String  Data  Type 

Variable  names  are  preceded  with  a  “$”  sign  to  indicate  that  they  contain  character  string 
data.  The  dollar  sign  is  not  considered  in  the  character  count  of  the  variable  name.  For 
example,  the  program  instruction: 

$string_l  =  “Adept  V+” 

allocates  the  string  variable  “string  1”  and  assigns  it  the  value  “Adept  V+”.  The 
character  count  of  the  variable  name  “string  1”  is  8.  String  variables  can  contain  from  0 
to  128  characters  and  any  ASCII  character  can  appear  in  a  string  variable.  String 
constants  can  also  have  0  to  128  characters.  However,  only  ASCII  characters  32  through 
126  (excluding  ASCII  34, ")  can  appear  in  a  string  constant. 

11.2.4.  Real  and  Integer  Data  Types 

Numbers  that  have  a  whole  number  and  a  fractional  part  belong  to  the  data  type  “real”. 
Numeric  values  having  only  a  whole  number  belong  to  the  data  type  “integer”.  In 
general,  V+  does  not  require  you  to  differentiate  between  these  two  data  types.  If  an 
integer  is  required  and  you  supply  a  real,  V+  will  promote  the  real  to  an  integer  by 
rounding  (not  truncation).  Where  real  values  are  required,  V+  considers  an  integer  a 
special  case  of  a  real  that  does  not  have  a  fractional  part.  The  default  real  type  is  a 
signed,  32-bit  IEEE  single-precision  number.  Real  values  can  also  be  stored  as  64-bit 
IEEE  double-precision  numbers  if  they  are  specifically  typed  using  the  DOUBLE 
instruction. 

The  range  of  integer  values  is: 
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-16,777,216  to  16,777,215 


The  range  of  single-precision  real  values  is: 

±3.4*10^* 

The  range  of  douhle-precision  real  values  is: 

+1.8*10^°’^ 

In  almost  all  situations  where  a  numeric  value  of  variable  can  be  used,  a  numeric 
expression  can  also  be  used.  The  following  examples  all  result  in  “x”  having  the  same 
value: 

X  =  3 
x-6/2 
X  =  SQRT(9) 

X  =  SQR(2)  - 1 
X  =  9  MOD  6 

V+  does  not  have  a  specific  logical  (Boolean)  data  type.  Any  numeric  value,  variable,  or 
expression  can  be  used  as  a  logical  data  type.  V+  considers  0  to  be  false  and  any  other 
value  to  be  true.  When  a  real  value  is  used  as  a  logical  data  type,  the  value  is  first 
promoted  (rounded)  to  an  integer.  There  are  four  logical  constants,  TRUE  and  ON  that 
will  resolve  to  -1,  and  FALSE  and  OFF  that  will  resolve  to  0.  These  constants  can  be 
used  anywhere  a  Boolean  expression  is  expected. 

11.2.5.  Location  Data  Types 

V+  uses  two  data  types  to  represent  locations,  transformations  and  precision  points.  A 
transformation  is  a  set  of  six  components  that  uniquely  identifies  a  location  in  Cartesian 
space  and  the  orientation  of  the  motion  device  end-of-arm  tooling  at  that  location.  A 
transformation  can  also  represent  the  location  of  an  arbitrary  local  reference  frame.  The 
first  three  components  of  a  transformation  variable  are  the  values  for  the  points  on  the  X, 
Y,  and  Z  axes.  The  second  three  components  of  a  transformation  variable  specify  the 
orientation  of  the  end-of-arm  tooling.  These  three  components  are  yaw,  pitch,  and  roll. 

A  precision  point  includes  an  element  for  each  “joint”  in  the  motion  device.  Rotational 
joint  values  are  measured  in  degrees;  translational  joint  values  are  measured  in 
millimeters.  These  values  are  absolute  with  respect  to  the  motion  device’s  home  sensors 
and  cannot  be  made  relative  to  other  locations  or  coordinate  frames. 

11.2.6.  Arrays 
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V+  supports  arrays  of  up  to  three  dimensions.  Any  V+  data  type  can  be  stored  in  an 
array.  Like  simple  variables,  array  allocation  and  typing  is  dynamic. 

11.2.1.  Variable  Classes 

In  addition  to  having  a  data  type,  variables  belong  to  one  of  three  classes,  GLOBAL, 
LOCAL,  or  AUTOMATIC.  These  classes  determine  how  a  variable  can  be  altered  by 
different  calling  instances  of  a  program. 

11.2.7.1.  Global  Variables 

This  is  the  default  class.  Unless  a  variable  is  specifically  declared  to  be  LOCAL  or 
AUTO,  a  newly  created  variable  will  be  considered  global.  Global  variables  can  be 
accessed  by  any  executing  program. 

11.2.7.2.  Local  Variables 

Local  variables  are  created  by  a  program  instruction  similar  to: 

LOCAL  the_local_var 

In  this  example,  “the_local_var”  is  declared  as  a  local  variable.  Local  variables  are 
available  to  all  calling  instances  of  a  program.  In  other  words,  a  local  variable  that  is 
changed  during  a  recursive  call  of  a  program  will  be  changed  in  all  instances  of  the 
recursive  program. 

11.2.7.3.  Automatic  Variables 

Automatic  veiriables  are  created  by  a  program  instruction  similar  to: 

AUTO  the  auto  var 

In  this  example,  “the_auto_var”  is  declared  as  an  automatic  variable.  Automatic 
variables  can  only  be  changed  by  a  particular  calling  instance  of  a  program. 

11.3.  Operators 

II.3.1.  Assignment  Operator 

The  equal  sign  (=)  is  used  to  assign  a  value  to  a  numeric  or  string  variable.  The  variable 
being  assigned  a  value  must  appear  by  itself  on  the  left  side  of  the  operator.  The  right 
side  of  the  equal  sign  can  contain  any  variable  or  value  of  the  same  data  type  as  the  left 
side,  or  any  expression  that  resolves  to  the  same  data  type.  Location  variables  use  the 
SET  instruction  for  assignment  and  may  not  use  the  equal  sign  assignment  operator. 
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II.3.2.  Mathematical  Operators 


V+  uses  the  standard  mathematical  operators;  +,  *,  /,  and  MOD. 

11.3.3.  Relational  Operators 

V+  uses  the  standard  relational  operators;  =,  <,  >,  <=,  >=,  and  o. 

11.3.4.  Logical  Operators 

V+  uses  the  standard  logical  operators;  NOT,  AND,  OR,  and  XOR. 

11.3.5.  String  Operator 

In  V+,  strings  can  be  concatenated,  or  joined,  using  the  “+”  operator. 

11.3.6.  Order  of  Evaluation 

Expressions  are  not  evaluated  in  a  simple  left  to  right  fashion  in  V+.  Table  B.l  shows  the 
order  of  evaluation.  Operators  on  the  same  line  have  the  same  precedence  and  are 
evaluated  left  to  right.  Parenthesis  can  be  used  in  the  normal  manner  to  change  the 
evaluation  order  within  an  expression. 


Evaluation 

Order 

Operator 

First 

NOT 

-  (Unary  minus) 

*,  /,  MOD,  AND 

+,  -,  OR,  XOR 

Last 

=,<=>=<,  >,o 

Table  B.I.  Order  of  Operator  Evaluation 


II.4.  The  SEE  Editor 

The  SEE  editor  is  a  full  functioned  screen  editor  that  is  provided  with  the  V+  control 
system  and  programming  language.  The  SEE  editor  performs  syntax  checks  on  each  line 
as  it  is  entered.  The  beginning  of  each  invalid  line  is  marked  with  a  question  mark.  The 
editor  automatically  capitalizes  language  keywords  and  insert  the  appropriate  amount  of 
spaces  between  keywords,  variables,  and  operators.  Additionally,  the  editor 
automatically  indents  program  lines  by  the  proper  amount  based  on  the  level  of  nesting. 
The  “.PROGRAM”  line  of  each  program  is  inserted  when  the  SEE  editor  first  creates  the 
program.  The  editor  also  places  the  .END  statement  at  the  end  of  each  program.  It  is 
important  to  note  that  the  editor  works  on  programs  in  system  memory.  It  does  not  read 
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programs  from  disk  or  write  programs  to  disk.  This  must  be  accomplished  with  monitor 
commands.  Use  of  the  SEE  editor  is  described  in  the  appropriate  Adept  Manuals. 

III.  Monitor  Commands 

Monitor  commands  are  commands  that  are  entered  at  the  system  prompt.  The  following 
section  describes  some  of  the  most  used  commands.  They  are  grouped  into  the  following 
three  categories;  system  control  and  information,  disk  commands,  and  program  control. 

Note:  Keywords  are  shown  in  uppercase  and  arguments  are  shown  in  lowercase.  Required  keywords, 
parameters,  and  marks  such  as  equal  signs  and  parenthesis  are  shown  in  bold  type;  optional 
keywords,  parameters,  and  marks  are  shown  in  regular  type. 

III.l.  System  Control  and  Information  Commands 

These  commands  control  various  aspects  of  the  system  or  provide  information  about  the 
system. 

CALIBRATE 

Initialize  the  robot  positioning  system. 

DELETEL  loc_var, . . .,  loc  var 

Delete  the  named  location  variables  from  the  system  memory. 

DELETER  real_var, . . .,  real  var 

Delete  the  named  real-valued  variables  from  the  system  memory. 

DELETES  str  var, . . .,  str  var 

Delete  the  named  string  variables  from  the  system  memory. 

DIRECTORY  select 

Display  the  names  of  some  or  all  the  programs  in  the  system  memory. 

DO  instruction 

Execute  a  single  program  instruction  as  though  it  were  the  next  step  in  the  current 
main  control  program,  or  the  next  step  in  the  specified  task/program  context. 

ENABLE  switch, . . .,  switch 

Turn  on  one  or  more  system  control  switches. 

FREE  select 

Display  the  percentage  of  available  system  memory  not  currently  in  use. 

HERE  loc  variable 
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Define  the  value  of  a  transformation  or  precision-point  variable  to  be  equal  to  the 
current  robot  location. 

LISTL  location, . . location 

Display  the  values  of  the  list  locations. 

LISTR  expression, . . .,  expression 

Display  the  values  of  the  real  variables  specified. 

LISTS  string, . . .,  string 

Display  the  values  of  the  string  variables  specified. 

SEE  program_name/qualifier 

Invoke  the  screen-oriented  program  editor  to  allow  a  program  to  be  created,  viewed, 
or  modified. 

STATUS  select 

Display  status  information  for  the  system  and  the  programs  being  executed. 

SPEED  speed_factor 

Specify  the  speed  of  all  subsequent  robot  motions  commanded  by  a  robot  control 
program. 

ZERO  select 

Reinitialize  the  V+  system  and  delete  all  programs  and  data  in  the  system  memory. 
Delete  all  user-defined  windows,  fonts,  and  icons  fi’om  graphics  memory. 

III.2.  Program  Control  Commands 

These  commands  control  programs  that  are  currently  loaded  in  memory. 

ABORT  task_num 

Terminate  execution  of  a  control  program. 

COMMANDS  program 

Initiate  processing  of  a  command  program. 

COPY  new_program  =  old_program 

Create  a  new  program  in  system  memory  as  a  copy  of  an  existing  program  in 
system  memory. 

DELETE  program, . . .,  program 

Delete  the  listed  programs  firom  the  system  memory. 

EXECUTE  task_num  program(param_list),  cycles,  step,  priority  [i] 
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Begin  execution  of  a  control  program. 


KILL  task_num 

Clear  a  program  execution  stack  and  detach  any  I/O  devices  that  are  attached. 

RENAME  new_program_name  =  oldjprogramname 

Change  the  name  of  a  user  program  in  memory  to  the  new  name  provided. 

III.3.  Disk  Commands 

These  commands  perform  functions  related  to  files  and  magnetic  storage  media. 

FCOPY  new_file  =  old_file 

Copy  the  information  in  an  existing  disk  file  to  a  new  disk  file. 

FDELETE  file_spec 

Delete  one  or  more  disk  files  matching  the  given  file  specification. 
FDIRECTORY/qualifier  file_spec 

Display  information  about  the  files  on  a  disk,  along  with  the  amount  of  space  still 
available  for  storage.  Create  and  delete  subdirectories  on  disks. 

FLIST  file_spec 

List  the  contents  of  the  specified  disk  file  on  the  system  terminal. 

FORMAT  A:/qualifier 

Initialize  and  erase  a  FLOPPY  disk. 

FRENAME  new_fi[le  =  old  file 

Change  the  name  of  a  disk  file. 

LOAD  switch  file  spec 

Load  the  contents  of  the  specified  disk  file  into  the  system  memory. 

STORE  /levels  file_spec  =  program_name, . . .,  program_name 
Store  programs  and  variables  in  a  disk  file. 

STOREL  /levels  file_spec  =  program_name, . . .,  program_name 
Store  location  variables  in  a  disk  file. 

STORER  /levels  file_spec  =  program_name, . . .,  program_name 
Store  real  variables  in  a  disk  file. 

STORES  /levels  file_spec  =  program_name, . . .,  program_name 
Store  string  variables  in  a  disk  file. 
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IV.  Language  Commands 


Language  commands  are  commands  that  are  used  within  executable  programs.  The 
following  section  describes  some  of  the  most  used  commands. 


Note:  Keywords  are  shown  in  uppercase  and  arguments  are  shown  in  lowercase.  Required  keywords, 
parameters,  and  marks  such  as  equal  signs  and  parenthesis  are  shown  in  bold  type;  optional 
keywords,  parameters,  and  marks  are  shown  in  regular  type. 


APPRO  location,  distance 
APPROS  location,  distance 

Start  a  robot  motion  toward  a  location  defined  relative  to  the  specified  location. 

ATTACH  (lun) 

ATTACH  (alun,  mode)  Sdevice 

Make  a  device  available  for  use  by  the  application  program. 

AUTO  variable, . . .,  variable 
AUTO  type  variable, . . .,  variable 

Declare  temporary  variables  that  are  automatically  created  on  the  program  stack 
when  the  program  is  entered. 

BRAKE 

Abort  the  current  robot  motion 

BREAK 

Suspend  program  execution  until  the  current  motion  completes. 

CALL  program(arg_list) 

Suspend  execution  of  the  current  program  and  continue  execution  with  a  new 
program  (that  is,  a  subroutine). 

CASE  value  OF 

Initiate  processing  of  a  CASE  structure  by  defining  the  value  of  interest. 

DEPART  distance 
DEPARTS  distance 

Start  a  robot  motion  away  from  the  current  location. 

DETACH  (logical_unit) 

Release  a  specified  device  from  the  control  of  the  application  program. 


DO 

Introduce  a  DO  program  structure. 

66 


DOS  string,  error 

Execute  a  program  instruction  defined  by  a  string  expression. 


END 

Mark  the  end  of  a  control  structure. 

EXECUTE  program(param_list) 

EXECUTE  task_num  program(param_list) 

Begin  execution  of  a  control  program. 

FOPENR  (lun,  record_len,  mode)  file_spec 
FOPENW. . . 

FOPENA  . . . 

FOPEND  . . . 

Open  a  disk  file  for  read-only,  read-write,  read- write-append,  or  read-directory, 
respectively,  as  indicated  by  the  last  letter  of  the  instruction  name. 

FOR  loop  var  =  initial  TO  final  STEP  increment 

Execute  a  group  of  program  instructions  a  certain  number  of  times. 

GLOBAL  type  var, . . .,  var 

Declare  a  variable  to  be  global  and  specify  the  type  of  the  variable. 

GOTO  label 

Perform  an  unconditional  branch  to  the  program  step  identified  by  the  given  label. 

HALT 

Stop  program  execution  and  do  not  allow  the  program  to  be  resumed. 

IF  logical_expr  GOTO  label 

Branch  to  the  specified  label  if  the  value  of  a  logical  expression  is  TRUE  (nonzero). 

IF  logical_expr  THEN 

Conditionally  execute  a  group  of  instructions  (or  one  of  two  groups)  depending  on 
the  result  of  a  logical  expression. 

KEYMODE  first_key,  last_key  =  mode,  setting 

Set  the  behavior  of  a  group  of  keys  on  the  manual  control  pendant. 

LATCH  0 

Return  a  transformation  value  representing  the  location  of  the  robot  at  the 
occurrence  of  the  last  external  trigger. 


LATCHED  (select) 
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Return  the  status  of  the  external  trigger,  and  of  the  information  it  causes  to  be 
“latched”. 

LOCAL  type  variable, . . .,  variable 

Declare  permanent  variables  that  are  defined  only  within  the  current  program. 

MOVE  location 
MOVES  location 

Initiate  a  robot  motion  to  the  position  and  orientation  described  by  the  given 
location. 

PAUSE 

Stop  program  execution  but  allow  the  program  to  be  resumed. 

PENDANT  (select) 

Return  input  from  the  manual  control  pendant. 

PROMPT  output_string,  variable_list 

Display  a  string  on  the  system  terminal  and  wait  for  operator  input. 

REACT  signal_num,  program,  priority 

Initiate  continuous  monitoring  of  a  specified  digital  signal  and  automatically  trigger 
a  subroutine  call  if  the  signal  properly  transitions. 

REACTI  signal_num,  program,  priority 

Initiate  continuous  monitoring  of  a  specified  digital  signal.  Automatically  stop  the 
current  robot  motion  if  the  signal  properly  transitions  and  optionally  trigger  a 
subroutine  call. 

READ  (lun,  record_num,  mode)  var_list 

Read  a  record  from  an  open  file,  or  from  an  attached  device  that  is  not  file  oriented. 

RETURN 

Terminate  execution  of  the  current  subroutine  and  resume  execution  of  the  last- 
suspended  program  at  the  step  following  the  CALL  or  CALLS  instruction  that 
caused  the  subroutine  to  be  invoked. 

SET  location_var  =  locatioii_value 

Set  the  value  of  the  location  variable  on  the  left  equal  to  the  location  value  on  the 
right  of  the  equal  sign. 

SIG  (signal_num, . . .,  signal_num) 

Return  the  logical  AND  of  the  states  of  the  indicated  digital  signals. 


SIGNAL  signal  num, . . .,  signal  num 
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Turn  “on”  or  “off’  external  digital  output  signals  or  internal  software  signals. 


SPEED  speedfactor 

Set  the  nominal  speed  for  subsequent  robot  motions. 

SPEED  (select) 

Return  one  of  the  system  motion  speed  factors. 

STOP 

Terminate  execution  of  the  current  program  cycle. 

TIMER  timer_number  =  timevalue 

Set  the  specified  system  timer  to  the  given  time  value. 

TIMER  (timer_number) 

Retiun  the  current  time  value  (in  seconds)  of  the  specified  system  timer. 

UNTIL  expression 

Indicate  the  end  of  a  DO  ...  UNTIL  control  structure  and  specify  the  expression  that 
is  evaluated  to  determine  when  to  exit  the  loop.  The  loop  continues  to  be  executed 
until  the  expression  value  is  non-zero. 

WAIT.EVENT  mask,  timeout 

Suspend  program  execution  until  a  specified  event  has  occurred,  or  until  a  specified 
amount  of  time  has  elapsed. 

WHILE  condition  DO 

Initiate  processing  of  a  WHILE  structure  if  the  condition  is  TRUE,  or  skipping  of 
the  WHILE  structure  if  the  condition  is  initially  FALSE. 

WRITE  (lun,  record  num,  mode)  forniat_list 

Write  a  record  to  an  open  file,  or  to  an  attached  device  that  is  file  oriented. 


69 


APPENDIX  C 


UTAP  Messages 


Note:  Bold  and  Italicized  messages  have  been  implemented  in  this  Thesis  Project.  An 
asterisk  indicates  a  message  added  to  the  specification  for  the  purpose  of  this 
Project. 


GENERIC  (42) 

US_STARTUP 

US_SHUTDOWN 

US_RESET 

US_ENABLE 

US_DISABLE 

US_ESTOP 

US_START 

US_STOP 

US_ABORT 

US_HALT 

US  INIT 

usIhold 

US_PAUSE 

US_RESUME 

US_ZERO 

US_BEGIN_SINQLE_STEP 

US_NEXT_SINGLE_STEP 

US_CLEAR_SINGLE_STEP 

US_BEGIN_BLOCK 

US_END_BLOCK 

US_BEGIN_PLAN 

US_END_PLAN 

US_USE_PLAN 

US_BEGIN_MACRO 

US_END_MACRO 

us_usejvlacro 

US_BEGIN_EVENT 

US_END_EVENT 

US_MARK_BREAKPOINT 

US_MARK_EVENT 

US_GET_SELECTION_ID 

US_POST_SELECTION_ID 

US_USE_SELECTION 

US_USE_AXIS_MASK 

US_USE_EXT_ALGORITHM 

US_LOAD_EXT_PARAMETER 

US_GET_EXT_DA  TA_  VAL  UE 

US_POST__EXT_DA  TA_  VAL  UE 

US_SET_EXT_DATA_VALUE 

US_LOAD_STATUS_TYPE 

US_LOAD_STATUS_PERIOD 

US_GENERIC_STATUS_REPORT 

ERRORS  (9) 

US_ERROR_COMMAND_NOT_IMPLEMENTED 

US_ERROR_COMMAND_ENTRY 

US_ERROR_DUPLICATE_NAME 

US_ERROR_BAD_DATA 

US_ERROR_NO_DATA_AVAILABLE 

US_ERROR_SAFETY_VIOLATION 

US  ERROR  LIMIT  EXCEEDED 


US_ERROR_OVER_SPECIFIED 

US_ERROR_UNDER_SPECIFIED 

AXIS  SERVO  (34) 

US_AXIS_SERVO_USE_ANGLE_UNITS 

US_AXIS_SERVO_USE_RADIAN_UNITS 

US_AXIS_SERVO_USE_ABS_POSITION_MODE 

US_AXIS_SERVO_USE_REL_POSITION_MODE 

US_AXIS_SERVO_USE_ABS_VELOCITY_MODE 

US_AXIS_SERVO_USE_REL_VELOCITY_MODE 

US_AXIS_SERVO_USE_PID 

US_AXIS_SERVO_USE_FEEDFORWARD_TORQUE 

US_AXIS_SERVO_USE_CURRENT 

US_AXIS_SERVO_USE_VOLTAGE 

US_AXIS_SERVO_USE_STIFFNESS 

US_AXIS_SERVO_USE_COMPLIANCE 

US_AXIS_SERVO_USE_IMPEDANCE 

US_AXIS_SERVO_START_GRAVITY_ 

COMPENSATION 

US_AXIS_SERVO_STOP_GRAVITY_ 
COMPENSATION 
US_AXIS_SERVO_LOAD_DOF 
US_AXIS_SERVO_LOAD_CYCLE_TIME 
US_AXIS_SERVO_LOAD_PlD_GAIN 
US_AXIS_SERVO_LOAD_JOINT_LIMIT 
US_AXIS_SERVO_LOAD_VELOCITY_LIMIT 
US_AXIS_SERVO_LOAD_GAIN_LIMIT 
US_AXIS_SERVO_LOAD_DAMPING_VALUES 
US_AXIS_SERVO_HOME 
US_AXIS_SERVO_SET_BREAKS 
US_AXIS_SERVO_CLEAR_BREAKS 
US_AXIS_SERVO_SET_TORQUE 
US_AXIS_SERVO_SET_CURRENT 
US_AXIS_SERVO_SET_VOLTAGE 
US_AXIS_SER  VO_SET_POSITION 
US_AXIS_SER  VOJSET_  VELOCITY 
US_AXIS_SERVO_SET_ACCELERATION 
US_AXIS_SERVO_SET_FORCES 
US_AXIS_SERVO_JOG 
US_AXIS_SERVO_JOG_STOP 

TOOL  (14) 

US_SPINDLE_RETRACT_TRAVERSE 

US_SPINDLE_LOAD_SPEED 

US_SPINDLE_START_TURNING 

US_SPINDLE_STOP_TURNING 

US_SPINDLE_RETRACT 

US_SPINDLE_ORIENT 

US_SPINDLE_LOCIC_Z 

US_SPINDLE_USE_FORCE 

US_SPINDLE_USE_NO_FORCE 

US  FLOW  START  MIST 
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US_FLOW_STOP_MIST 

US_FLOW_START_FLOOD 

US_FLOW_STOP_FLOOD 

US_FLOW_LOAD_PARAMETERS 

SENSOR  (45) 

US_START_TRANSFORM 

US_STOP_TRANSFORM 

US_START_FILTER 

US_STOP_FILTER 

US_SENSOR_USE_MEASUREMENT_UNITS 
US_SENSOR_LOAD_SAMPLING_SPEED 
US_SENSOR_LOAD_FREQUENCY 
US_SENSOR_LOAD_TRANSFORM 
US_SENSOR_LOAD_FILTER 
US_SENSOR_GET_READING 
US_SENSOR_GET_A  TTRIBUTES_READING 
US_VECTOR_SENSOR_GET_READING 
US_FT_SENSOR_POST_READING 
US_SCALAR_SENSOR_POST_READING 
US_VECTOR_SENSOR_POST_READING 
US_2D_SENSOR_LOAD_ARRAY_PATTERN 
US_2D_SENSOR_USE_ARRAY_TYPE 
US_2D_SENSOR_GET_READING 
US_2D_SENSOR_POST_READING 
US_IMAGE_USE_FRAME_GRAB_MODE 
USJMAGE_USE_fflSTOGRAM_MODE 
USJMAGE_USE_CENTROID_MODE 
US_IMAGE_USE_GRAY_LEVEL_MODE 
USJMAGE_USE_THRESHOLD_MODE 
USJMAGE_COMPUTE_SPATIAL_DERIVATIVES 
MODE 

US_IMAGE_COMPUTE_TEMPORAL_ 
DERIVATIVES_MODE 
US  IMAGE_USE_SEGMENTATION_MODE 
USJMAGE_  USE_RECOGNITION_MODE 
US_IMAGE_COMPUTE_RANGE_MODE 
US_IMAGE_COMPUTE_FLOW_MODE 
USJMAGE_LOAD_CALIBRATION 
US_IMAGE_SET_POSITION 
US_IMAGE_ADJUST_POSITION 
US_IMAGE_ADJUST_FOCUS 
US_IMAGE_POST_SPECIFICATION 
US_IMAGE_POST_PIXEL_MAP_READING 
US_IMAGE_POST_fflSTOGRAM_READING 
US_IMAGE_POST_XY_CHAR_READING 
USJMAGE_POST_BYTE_SYMBOLIC_READING 
US_IMAGE_POST_THRESHOLD_READING 
US_IMAGE_POST_SPATIAL_DERIVATIVE_ 
READING 

USJMAGE_POST_TEMPORAL_DERIVATIVE_ 

READING 

USJMAGE_POST_RECOGNITION_READING 

US_IMAGE_POST_RANGE_READING 

US_IMAGE_POST_FLOW_READING 

PROGRAMMABLEJO  (11) 

US_PIO_ENABLE 

US_PIO_DISABLE 

US_PIO_SETjmODE 

US_PIO_CONTROL_WRITE 

US_PIO_LOAD_SCALE 

US_PIO_DATA_WRITE 

US_PIO_DATA_READ 

VS_PIO_BIT_READ 

US_PIO_BIT_SET 

US_PIO_TOGGLE_BIT 


US_PIO_POST_DATA 

TASK_LEVEL_CONTROL  (78) 

US_TLC_USEJOINT_REFERENCE_FRAME 

US_TLC_USE_CARTESIAN_REFERENCE_FRAME 

US_TLC_USE_REPRESENTATION_UNITS 

US_TLC_USE_ABSOLUTE_POSITIONING_MODE 

US_TLC_USE_RELATIVE_POSITIONING_MODE 

US_TLC_USE_WRIST_COORDINATE_FRAME 

US_TLC_USE_TOOL_TIP_COORDINATE_FRAME 

US_TLC_CHANGE_TOOL 

US_TLC_USE_MODIFIED_TOOL_LENGTH_ 

OFFSETS 

US_TLC_USE_NORMAL_TOOL_LENGTH_ 

OFFSETS 

US_TLC_USE_NO_TOOL_LENGTH_OFFSETS 

US_TLC_USE_KINEMATIC_RING_POSmONING_ 

MODE 

US_TLC_START_MANUAL_MOTION 

US_TLC_STOP_MANUAL_MOTION 

US_TLC_START_AUTOMATIC_MOTION 

US_TLC_STOP_AUTOMATIC_MOTION 

US_TLC_START_TRANSVERSE_MOTION 

US_TLC_STOP_TRANSVERSE_MOTION 

US_TLC_START_GUARDED_MOTION 

US_TLC_STOP_GUARDED_MOTION 

US_TLC_START_C0MPLIANT_M0T10N 

US_TLC_STOP_COMPLIANT_MOTION 

US_TLC_START_FINE_MOTION 

US_TLC_STOP_FINE_MOTION 

US_TLC_START_MOVE_UNTIL_MOTION 

US_TLC_STOP_MOVE_UNTIL_MOTION 

US_TLC_START_STANDOFF_DISTANCE 

US_TLC_STOP_STANDOFF_DISTANCE 

US_TLC_START_FORCE_POSlTIONING_MODE 

US_TLC_STOP_FORCE_POSITIONING_MODE 

US_TLC_LOAD_DOF 

US_TLC_LOAD_CYCLE_TIME 

US_TLC_L0AD_REPRESENTAT10N_UN1TS 

US_TLC_LOAD_LENGTH_UNITS 

US_TLC_LOAD_RELATIVE_POSITIONING 

US_TLC_ZERO_RELATIVE_POSITIONING 

US_TLC_ZERO_PROGRAM_ORlGIN 

US_TLC_LOAD_KINEMATIC_RING_ 

POSITIONING_MODE 

US_TLC_LOAD_BASE_PARAMETERS 

US_TLC_LOAD_TOOL_PARAMETERS 

US_TLC_LOAD_OBJECT 

US_TLC_LOAD_OBJECT_BASE 

US_TLC_LOAD_OBJECT_OFFSET 

US_TLC_LOAD_DELTA 

US_TLC_LOAD_OBSTACLE_VOLUME 

US_TLC_LOAD_NEIGHBORHOOD 

US_TLC_LOAD_FEED_RATE 

US_TLC_LOAD_TRAVERSE_RATE 

US_TLC_LOAD_ACCELERATION 

US_TLC_LOAD_JERK 

US_TLC_LOAD_PROXIMITY 

US_TLC_LOAD_CONTACT_FORCES 

US_TLC_LOAD_JOINT_LIMIT 

US_TLC_LOAD_CONTACT_FORCE_LIMIT 

US_TLC_LOAD_CONTACT_TORQUE_LIMIT 

US_TLC_LOAD_SENSOR_FUSION_POS_LIMIT 

US_TLC_LOAD_SENSOR_FUSION_ORIENT_LIMIT 

US_TLC_LOAD_SEGMENT_TIME 

US_TLC_LOAD_TERMINATION_CONDITION 

US_TLC_INCR_VELOCITY 
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US_TLC_INCR_ACCELERATION 

US_TLC_SET_GOAL_POSITION 

US_TLC_GOAL_SEGMENT 

US_TLC_ADJUST_AXIS 

US_TLC_UPDATE_SENSOR_FUSION 

US_TLC_SELECT_PLANE 

US_TLC_USE_CUTTER_RADIUS_ 

COMPENSATION 

US_TLC_START_CUTTER_RADIUS_ 

COMPENSATION 

US_TLC_STOP_CUTTER_RADIUS_ 

COMPENSATION 

US_TLC_STRAIGHT_TRAVERSE 

US_TLC_ARC_FEED 

US_TLC_STRAIGHT_FEED 

US_TLC_PARAMETRIC_2D_CURVE_FEED 

US_TLC_PARAMETRIC_3D_CURVE_FEED 

US_TLC_NURBS_KNOT_VECTOR 

US_TLC_NURBS_CONTROL_POINT 

US_TLC_NURBS_FEED 

US_TLC_TELEOP_FORCE_REFLECTION_UPDATE 

TASK_DESCRIPTION  (10) 

US_TDS_LOAD_USER 

US_TDS_SELECT_PROGRAM 

US_TDS_EXECUTE_PROGRAM 

US_TDS_SELECT_OPERATION 

US_TDS_SELECT_OPMODE 

US_TDS_LOAD_SELECTIONS 

US_TDS_LOAD_REFERENCE_UNITS 

US_TDS_LOAD_RATE_DEFAULTS 

US_TDS_LOAD_ORIGIN 

US_TDS_LOAD_SENSING_DEFAULTS 

TASK_KNOWLEDGE  (4) 

US_TK_DEFINE_FRAMEWORK 

US_TK_MACRO_CREATE 

US_TK_MACRO_DELETE 

US_TK_MACRO_MODIFY 

PARENT_TASK_PROGRAM_SEQUENCING  (7) 
US_PTPS_SELECT_AGENT 
US_PTPS_SELECT_TOOL 
US_PTPS_SELECT_SENSOR 
US_PTPS_INTERP_RUN_PLAN 
US_PTPS_INTERP_HALT_PLAN 
US_PTPS_INPUT_REQUEST 
US_PTPS_OUTPUT_ENABLE_SUBSYSTEM 

TASK_PROGRAM_SEQUENCING  (10) 
US_TPS_FREESPACE_M0T10N 
US_TPS_GUARDED_M0T10N 
US_TPS_C0NTACT_M0T10N 
US_TPS_SET_SUPERVISORY_MODE 
US_TPS_SELECT_FEATURE 
US_TPS_SELECT_MATERIAL 
US_LOAD_OBSTACLE 
US_LOAD_PATTERN 
US_TPS_MARK_EVENT 
US_TPS_ENABLE 

OPERATOR_lNTERFACE  (9) 
US_BEGIN_FRAMEWORK 
US_END_FRAMEWORK 
US_CREATE_FRAMEWORK 
US_DELETE_FRAMEWORK 
US  ADD  SYMBOLIC  ITEM 


US_DELETE_SYMBOLIC_ITEM 

US_ADD_SYMBOLIC_ITEM_ATTR 

US_DELETE_SYMBOLICJTEM_ATTR 

US_SET_SYMBOLIC_ITEM_ATTR 

OBJECT_MODELING  (3) 

US_OM_CREATE 

US_OM_DELETE 

US_OM_MODIFY 

OBJECT_CALIBRATION  (4) 
US_OC_SET_CALIB 
US_OC_GET_CALIB 
US_OC_SET_ATTR 
US_OC_GET_ATTR 

OBJECT_KNOWLEDGE  (9) 
US_OK_RECORD 
US_OK_PLAYBACK 
US_OK_CREATE_OBJ 
US_OK_DELETE_OBJ 
US_OK_MODIFY 
US_OK_MODIFY_ATTRIBUTE 
US_OK_A  TTRIBUTE_QUER  Y 
US_OK_OUTPUT_REGISTERED_OBJ_ID 
US_OK_ATTRIBUTE_RESPONSE 

TRAJECTORY_DESCRIPTION  (15) 
US_TRD_OPEN 
US_TRD_ERASE 
US_TRD_RECORD 
US_TRD_RECORD_ON 
US_TRD_RECORD_OFF 
US_TRD_FIND 
US_TRD_NEXT 
US_TRD_PREVIOUS 
US_TRD_DELETE 
US_TRD_NAME_1TEM 
US_TRD_DELETE_ITEM 
US_TRD_SET_J01NT_M0DE 
US_TRD_SET_CARTESIAN_MODE 
US_TRD_MODIFY 
US_TRD_ADD_ELEMENT 

ANALYSlS_DlAGNOSlS_SYSTEM  (1) 
US_ADS_COLLISION_DETECTED 

UTAP_DATA_DEFS  (34) 

US_POSTJD 

US_GET_OBJECT_ID 

US_USE_OBJECT 

US_GET_FEATURE 

US_USE_FEATURE 

US_GET_VALUE 

US_POST_VALUE 

US_GET_LIST 

US_POST_LIST 

US_ATTRIBUTE_POST_RESPONSE 

US_ATTRIBUTE_GET_TIME 

US_ATTRIBUTE_GET_POSITION 

US_ATTRIBUTE_GET_ORIENTATION 

US_ATTRIBUTE_GET_POSE 

US_ATTRIBUTE_GET_VELOCITY 

US_ATTRIBUTE_GET_ACCELERATION 

US_ATTRIBUTE_GETJERK 

US_ATTRIBUTE_GET_FORCE 

US_ATTRIBUTE_GET_TORQUE 
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US_ATTR]BUTE_GET_MASS 

US_ATTRIBUTE_GET_TEMPERATURE 

US_ATTRIBUTE_GET_PRESSURE 

US_ATTRIBUTE_GET_VISCOSITY 

US_ATTRIBUTE_GET_LUMINANCE 

US_ATTRIBUTE_GET_HUMIDITY 

US_ATTRIBUTE_GET_FLOW 

US_ATTRIBUTE_GET_HARDNESS 

US_ATTRIBUTE_GET_ROUGHNESS 

US_ATTRIBUTE_GET_GEOMETRY 

US_ATTRIBUTE_GET_TOPOLOGY 

US_ATTRIBUTE_GET_SHAPE 

US_ATTRIBUTE_GET_PATTERN 

US_ATTRIBUTE_GET_MATERIAL 

US_ATTRIBUTE_GET_KINEMATICS 

Messages  Added  for  this  Project 
(Not  in  the  UTAP  Specification) 

*USjGET_EXT_LOCA  TION_DA  TA 

*US_SET_EXT_LOCA  TION_DA  TA 

*US_GRIPPER_CLOSE 

*US_GRIPPER_OPEN 

*VS_FT_SENSOR_DISABLE 

*US_FT_SENSOR_ENABLE 

*US  FT  SENSOR  MODE  SELECT 


APPENDIX  D 


Trajectory  Plots 
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Figure  D.l.  Joint  1  Position  Plots 
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APPENDIX  E 


Position  Error  Plots 
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Figure  E.3.  Joint  3  Error  for  Nominal  Trajectory 
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Non-Gain  Tuned  UTAP  — 
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Figure  E.13.  Joint  1  Error  for  Fast  Trajectory 


Figure  E.14.  Joint  2  Error  for  Fast  Trajectory 


85 


Figure  E.18.  Joint  6  Error  for  Fast  Trajectory 


APPENDIX  F 


TrjjgenCycle  Function  Source  Code 
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Original  TrjjgenCycle  Code  Modified  TrjjgenCycle  Code 
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at  the  end  of  each  cycle. 


APPENDIX  G 


Original  Palletizing  Application  V+  Source  Code 
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•PROGRAM  nonutap .demo {)  ht  =  VAL{$ht) 
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PROMPT  "Enter  an  approach  height:  ",  $ht  ;  Write  the  date,  time,  row,  and  col  info  to  the  audit  file 


WRITE  (flun)  $TIME(}  TYPE  "World  Coordinate  System  X  value:  ”,  DX{curr.loc) 

WRITE  (flun)  "Row  =  ",  row,  "  Col  =  ",  col  TYPE  "World  Coordinate  System  Y  value:  ",  DY{curr.loc) 

TYPE  "World  Coordinate  System  Z  value:  ",  DZ{curr.loc) 
Write  the  pick  location  info  to  the  audit  file  TYPE 


-O  Q  Q 
0)  a  a 
c  M  cq  u 
a  o  p<  a 
w  JJ  w  C/) 


rC  e  — .  s 

E-*  C 

s  s  in  p  a 

iH 

^  ^  O  ‘W  — ' 

C  C  H  c 

d  3  d 

rH  tH  O  w  IH 

IM  IM  E-<  «4-4 


^^0  4-1 

C  d  H 
d  d 

H  r-t  O  W 


id  iJ 
flJ  fi 
S  3  <1) 

O  0)  4J 


u 

M-l 

■d 

TO 

in 

i—l 

M 

d 

u 

4J 

G 

U 

Hi 

■H 

o 

Qi 

d) 

O 

rd 

o 

Id 

43 

H 

(Q 

u 

a 

S 

td 

y 

■d 

rH 

U 

u 

d 

Q 

oi 

o 

04 

f-i 

o 

JJ 

•H 

B 

0) 

o 

u 

o 

frt 

d  • 

<rt  cJ 

< 

43 

jj 

<u  jd  iJ  o 

E  4J  0}  (U 

(d  d  43  o 


92 


If  the  signal  was  for  coordinate  display  TYPE  "The  gripper  delay:  ",  PAEiAMETER (HAND. TIME) 

TYPE  "The  acceleration:  ",  ACCEL (1) 

IF  SIG(2102)  THEN  TYPE  "The  deceleration:  ",  ACCEL (2) 


•  PROGRAM  mcp.mainO 
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Write  the  menu  options  SIGNAL  2003 

WAIT  (SIG(-2003)  OR  SIG (-2100) ) 

WRITE  (mcp)  $CHR(18),  $CHR(41),  /S  WRITE  (mcp)  $CHR(28),  $CHR(3),  /S 

WRITE  (mcp)  "Cycle",  $CHR(9),  "Posit",  $CHR(9),  /S 

WRITE  (mcp)  "React",  $CHR(9),  "Reacti",  $CHR(9),  "  Stop",  /S  END 
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REACT  2003,  safe. resume  .PROGRAM  pnp(pick,  place,  ht) 

REACTI  2004,  safe.goback 

REACTI  2005,  stop. prog  ;  Name:  pnp 

;  Author:  Capt  Matthew  L.  June  -  GCS-96D 

Execute  programs  ;  Abstract:  This  is  a  simple  pick  and  place  program.  It  is  given  the 
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•  PROGRAM  safe.gobackO 


4J 

Cl 


?  e 

0)  rd  4-1 
43  O 
Cn  4J  & 


&  4J  M  3 

o  a  -H  u 

4->  (0  43  0) 


k  n$  (d 
••  O  Cl  43 
0)  43  -U 
E  4J  W  TS 

g  § 


96 


.PROGRAM  safe. resume ( ) 
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Move  to  safe  location  •  Move  to  a  safe  position 


This  program  is  UTAP-compliant 
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Author:  Capt  Matthew  L.  June  -  GCS-96D 

Abstract;  This  program  moves  the  manipulator  to  a  position  .PROGRAM  force .moveg (zero_force) 

determined  from  the  pallet  number  and  i  and  j  offsets.  Once  there, 

pick  up  a  part  and  move  to  a  position  75mm  above  the  pick  location.  ;  Name;  force. moveg 

;  Author:  Capt  Matthew  L.  June  -  GCS-96D 


Abstract:  Enables  guarded  mode  force  sensing  and  attempts  to  move  ;  Itnm  for  each  iteration  until  the  part  is  placed  on  the  table  surface, 

to  the  goal  location.  Returns  trip  status  of  the  sensor,  forces  at 

the  time  of  the  trip,  and  the  trip  location.  ;  This  program  is  UTAP-compliant 
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CALL  as_set_position (place :TRANS (0, 0, -75) ) 
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$arg[12],  $temp,  $command,  temp 
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END  VALUE  disk: 

$temp  =  $DECODE  ($ value, 
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SET  trip.pos  =  HERE 

•  PROGRAM  as_set_velocity  (joint_velocity‘}  trip  =  FALSE 
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IF  $attrib  ==  "Gripper  Delay"  THEN 

$data  =  $ENCODE {PARAMETER (HAND. TIME) ) 
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(channel) 


FOPENA  (channel,  0,  0)  $fnarne 


;  Abstract:  UTAP  message  to  read  sensor  attribute  values.  Maps 

FORCE. MODE  (-mode)  ;  to  the  V+  commands  "FORCE. READ”  and  " FORCE. OFFSET " . 
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•EVENT  0,  grip_delay 


APPENDIX! 


Palletizing  Application  Output 
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iw  =  2  Col  =  2 

e  pick  location  coordinates  are:  13-Sep-9G  09:19:48 

280.6106  -198.4456  214.8364  0  179.9998  89.62424)  Row  =  4  Col  =  2 

e  place  location  coordinates  are:  The  pick  location  coordinates  are: 

278.4757  102.2238  214.8365  0  179.9993  90.22086)  (  279.9548  -98.44778  214.8362  0  179.9998  89.62424) 
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Attempting  next  part 

Insertion  jammed  2.449036  mm  from  goal 
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iW  =  2  Col  =  2 

.e  pick  location  coordinates  are:  13-Sep-96  09:22:47 

278.4757  102.2238  214.8365  0  179.9993  90.22086)  Row  =  4  Col  =  2 

.e  place  location  coordinates  are:  The  pick  location  coordinates  are: 

280.6106  -198.4456  214.8364  0  179.9998  89.62424)  (  278.8612  202.223  214.8356  0  179.9993  90.22086) 


e  place  location  coordinates  are:  Attempting  next  part 

279.9548  -98.44778  214.8362  0  179.9998  89.62424)  Insertion  jammed  1.697792  mm  from  goal 
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Attempting  next  part 
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